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An estimation acoustic transducer based on sliding modes control 


Julio César Tovar Rodríguez, Floriberto Ortíz Rodríguez, Carlos Román Mariaca Gaspar 


Abstract — Electronic sensor devices in geophysical processes are required to measure and automate different tasks. Throughout 
history, people have created multiple type devices, but acoustics have an important application such as the content form 
description in deep wells, watersheds, lakes, caves, among others. The acoustic signal is capable of reflecting where other types of 
signals cannot operate, either by drawbacks or where fluid is displaced. 


A mathematical model is presented in this paper described in state space as a basic acoustic sensor description. The objective is 
to adjust the parameters allowing the acoustic device to describe a signal in its trajectory, representing in geophysical manner the 
cavity form. Therefore, the control is performed on the response of the acoustic sensor model, adjusted with a parameter 
estimation process. The simulation results counts convergence between the reference and identified signals. 


Keywords — Sliding modes, estimation, acoustic transducer, control. 
I. INTRODUCTION 


Acoustic processes are of particular interest in geophysical processes because they describe different phenomena in nature, 
such as the Doppler effects with its relative velocity between two bodies [4]; stochastic entropy [10] with 1ts pernicious effects 
when the signal exceeds the allowable thresholds [7]. The resonance commonly applies different methodologies describing the 
motion of an embryo in a womb or an egg, or the liquid levels in an oil well. Physically, the identification process is based on 
electronic sensors measuring and building the forms, allowing industrial automatic inspection where man has no access, or the 
eye cannot see, as the water depth sensing is performed by a sonar [6], [8], [9]. 


To meet the demands of science, multiple types of sensors such as photoelectric, magnetic, inductive, nuclear, acoustic, 
among other have been created. The acoustic sensor has a great potential still to be exploited in applications such as: content 
description in deep wells, watersheds, lakes, caverns, applied in places where solutions have a very rough shape container [6]. 


In general, the challenges of all the acoustic sensors are: 
a) The signal type must be consistent with the environment, where the moves measure permits describing the contents, 
b) All types of sensors are designed for a range defined without self-adjusting. 


An acoustic signal can be reflected in areas where other signal types cannot operate, either by the fluid drawbacks 
displacement or because they would require hard-reflected signals. For example, a distance of at least 500m in aqueous 
media, operating with power lines at different speeds. Large distances require high capacity signals: In this paper a control 
model acoustic sensor response with a parameter estimator as an adaptive technique, solves the problem considered in the 
first application point; such as, the reflection intensity offering a high capacity self-regulation descriptor distance sensing the 
distance range without, previously described. In some sense only a range is identified, hence the device needs self-regulation 
range distance with a limited level of uncertainty, adjusting the piezoelectric reference parameters system, which is firstly 
compared with a piezoelectric model tracking. In the event, where the results need the self-adjusting and controlling law, the 
parameters set is used within the model like an adjustable parameters description for long distances and rough cavities 
considering the initial conditions reference system [6], [8] and, [9]. 


To overcome current limiting, the control action regulating the acoustic signal level emitted by a piezoelectric device 
ensures that the reflected echo signal requires that the acoustic sensor intensity reading, analyzes the reflected signal [1]. The 
model and the control system were the basis for a particular container description, without presupposing the distance, adjusting 
the parameters through the measurement system and control action. 


Therefore, the piezoelectric model actuator according to [1] is simplified into the form: 
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X, = AX, + Bw, 
Y =CX, + Dw, 


(1) 


Where the matrix order correspond to the differential equation order withA € Roe Be Roe C € Re DE 
1 
Rion j We e Nip» Owe < o) 
Theorem 1. Let the model considered in in state space have the form (1). In agreement to (1) and [3], the recursive form 
1S: 


Y, =GY +HV, 2) 


Where:G, H are matrices bounded with G € Ro and, H = f(4,C,B,D), VEN (y, Oy, < oo} Proof (See Appendix). 


II. CONTROL LAW 


Theorem 2. The control law system V,* with respect to (2) has the form: 
V, =H*(E,-GY,) (3) 


With H* the pseudo-inverse matrix H, the innovation process E, considered in (2), and G, as a unknown matrix having 
the form G € Ra oe Proof (See Appendix). 


The piezoelectric device has a main problem which corresponds to parameter distance description [1], [4], described as 
G,. This is solved estimating the gain with a lower uncertainty in almost all points that make up its surface. 


III. PARAMETERS ESTIMATION 


Applying the control law (3) into the model described in (2), converges to reference system (Y;) only if the matrix G[1], 
[3] is known. Unfortunately, the reference system viewed as a Black Box scheme [3]; the matrix gain G is unknown, 
because it corresponds to the internal system description. Consequently, the estimation process is required describing the 
internal matrix gain through the time process [2], [3], [5]. 


Theorem 3. Let the recursive model (2), with answer have the stochastic matrix estimation based on [2], [3], [13]- 
[17]: 


m 
G: = FO, Sa 
With P,, Q; covariance and variance matrices, with respect to (2). Proof (See Appendix). 


Theorem 4. Let G, be a stationary process, the recursive form in discrete manner is (5) and is viewed in figure 1, based 
on [2], [3]. 


Ei m 


G: =a, Git B (5) 





Figure 1 Recursive form of G, considering stationary conditions. 
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A piezoelectric device developed as a mathematical model viewed as (1), considering the Black Box properties, only is 
observes input and output signals without knowing exactly the internally system operations. The control law does not affect 
the reference system, but the model through the parameters is estimated in the probability sense affecting the model 
converging to the reference piezoelectric device answer. All results are described in real numbers (IR), specifically over the 
hypothetical line that describes the container form. 


The piezoelectric block diagram using the control action with adaptation into the model system is shown in figure 2. 


Black Box Piezoeleciric device 





Figure 2 Piezoelectric system viewed as a control block diagram with parameters adjusted dynamically. 


Now, the control law system V,* described in (3) considering (5) has the form: 


t 


ne 
Vo =H (5,6%, (6) 


With H*the pseudo-inverse matrix H, the innovation process E, considered in (2), and G,, as a matrix estimation. 


IV. SIMULATION 


The piezoelectric signal (y+) with stochastic properties tracking the model output answer (9+) with parameters estimation 
affecting the control law action. Both considered in (2) is illustrated in figure 3. 
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Figure 3 Piezoelectric temporal signal and its tracking. 
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The adaptation scheme viewed in figure 1, was applied in the control law and into the model, observing that the answer 1s 
very narrow with respect to the real piezoelectric results. In figure 4, is observed the innovation process. 


Innovation Process 





0.025 ES E L z L E k L L L E 
0.02 - | l 
0.015 - | o] - 


0.01 - | | | | | | | | | | || | | | i 















































r r r r r a 
10 20 30 40 50 60 70 80 90 100 ¢ 


Figure 4 Innovation process through the time t 


The convergence rate generated between the reference signal and the tracking output model is measured in decibels based 
on stochastic entropy and has the form H, = —20[e,ln(e,) — (1/20)H,_,], with e, := y, — $, and the result is viewed in 
figure 4. 
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Figure 5. Stochastic entropy with respect to difference 
between the tracking and reference signal. 
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V. CONCLUSION 


This paper presented a model considering into the references as a piezoelectric device description. The control system over 
the model required matrix gain parameters estimation, having an adaptive movement using into the tracking operations. The 
theoretical results were developed by the dynamical model properties and the control action. The simulation tracking was 
acceptable in probability sense, with convergence rate measured in decibels in stochastic description manner. The output 
piezoelectric device had an evolution with innovation signal. The tracking permitted a great convergence with stationary 
conditions affecting the control action over the model in positive form, minimizing the convergence error near to 
piezoelectric answer with rough conditions. The control law depended on the internal parameters, with adjustable gains 
estimation. The simulation results described the proposal answer, with a convergence level bounded in its movements as 
shown in the entropy. 


















































APPENDIX 
Proof (Theorem 1). 
Let the model (1), with the first derivate described in: 
X — C X, + D Wr (7) 
Substituting in (7) to X; de (1), has: 
D 
Y, =CAX, + CBw+ Dw: (8) 


The internal state X, in agreement to (1) is described in (9) with respect to observable signal: 














X,=CY-C Dw, (9) 


t 


(9) in (8), has: 


























Y, = CACY, -CAC*Dw +CBw+Dw. (10) 


In symbolic form (10) is described in (11) with G := CAC*, H := [(=CAC* + CB) DJ], and V, := [w, w;]!. 














Y. =GY,+ HV, (11) 
Corresponding to (2).m 


Proof (Theorem 2). Let the system (2) accomplish with: 














M, M? <0 (12) 


Where the trajectory region with respect to the gain matrix M,, is described in: 














M: =—F (13) 


With F,, a continuous function bounded by intervals with uniform measure t, accomplishing with the innovation process: 





Y. =Y,4+F (14) 
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Considering to (2) in (13) has: 




















-F =GY+HV,-Y; (15) 


t t t 


The difference between 7, and Fin (15) is described in (16): 




















(r-r (0) ]=-Gy,- HF, (16) 


The system innovation process (2) according to (16), it is described in: 

ESY th (17) 
(17) in (16) and V, is developed in: 

V’ = H* (E; -GY,) (18) 
As a control law, described in (3). m 
Proof (Theorem 3). 


Let Zi = f(Yt), such as applying the second probability moment (2) with respect to Z, has: 














zly, a =GE|YZ] ) + HE {V,Z7 } (19) 


The mathematical operator properties in agreement to [2], [3] and, [5], the estimation is based on (19) has the form: 














G, = Gt z!|-ne(v2}\e{%z") (20) 


Now, defining (20) with respect to (18) to P,, Q; in: 














P = EY 21) -HE(VZ!):0 AS (21) 


And (21) in (20), the estimation matrix G, has the form: 
Gi = PO, (22) 


Viewed in (4). m 


Proof (Theorem4). Let (5) has the components in agreement to (21), with stationary conditions P,is described considering 
[2], [3], [5] in recursive form in differences: 


É 2 ) (23) 
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With a delay, P,_, is described in: 


1 t-l H t 
noppaa pep 




















(24) in (23) has: 














l 
P = (>) Z + HV,Z! + (1-1) A 
Considering that (22) delayed has the form: 


E = GAO 




















And (23) in (21), has: 

P= OE Z? + HVZ? + (8-1) GO) i 
(23) in (21), has: 

G: = (>) AA E Jo 
Minimizing (28) has: 
































2 


t t t 


t d i t—-1 gen + 


(29) Symbolically is described in: 
G: = A, Gi + p, 


With a,and f, as: 


_(t-1) G-0},Q, 


7 t 


t 














t 


Yz HVZ’ 
g -| 222 f i 2) 


And (30) is viewed in (5). m 


(24) 


(25) 


(26) 


(27) 


(28) 


(29) 


(30) 


(31) 
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Regularized divide and conquer training for dendrite morphological 
neurons* 


Erik Zamora and Humberto Sossa 


Abstract—We introduce regularization methods for training dendrite morphological neurons to avoid overfitting. Overfitting 
occurs if a learning model describes irrelevant noise instead of the fundamental relationship. We prevent this problem by limiting 
the depth of recursions in the proposed regularized training which is based on a divide and conquer strategy. We present the 
training algorithm in a recursive way as an efficient implementation. Experiments were performed based on several real and 
synthetic datasets. Results show that we can enhance the testing error and reduce the model complexity in classification tasks at 
low dimensionality. 


I. INTRODUCTION 


Dendrite morphological neurons (DMN) are another way to model pattern classes. Classical perceptrons with only one 
layer divide the input space into two regions, using a hyperplane as a decision boundary. In the case more layers are presented, 
perceptrons divide the input space using a hyper-surface. In contrast, dendrite morphological neurons divide the same space by 
several hyperboxes that together can create complex nonlinear decisions boundaries allowing separating classes with only one 
neuron (for example in Figure 1). This is not possible with one-layer-perceptron. Other advantages appear during training 
DMNs: 1) there are no convergence problems; 2) training is performed in only one epoch; and 3) it is deterministic, that is, 
every time 1t is executed, we obtain the same result. All of these advantages are that result of using morphological operations 
(min and max) instead of addition and multiplication. 


Recently, a training method for DMN based on divide and conquer strategy has been proposed in [1]. This method has shown 
better classification performance than other machine learning classical approaches, such as MLP with one hidden layer [2], 
support vector machines [3] and radial basis function networks [4]. However, the method described in [1] suffers from 
overfitting, because this approach is greedy, trying to classify perfectly every training pattern. In machine learning, overfitting 
occurs if a learning model describes irrelevant noise instead of finding data fundamental structure. An overfitted model has too 
many parameters relative to the number of training patterns and shows poor predictive performance. We illustrate this in 
Figure 1. Even when the non-regularized model has more hyperboxes than regularized model, this last simpler model presents 
a less testing error. In short, the non-regularized model tends to learn irrelevant variations in data affecting the predictive 
performance and learning generalization. In this paper, we propose using regularization methods to overcome this drawback of 
DMNs. 


The rest of the paper is organized as follows. In section II, we provide a short review of the related work. In section III, we 
give a concise description of DMNs. In section IV, we introduce our proposed regularized training method. In section V, we 
present the experiments, results, as well as a short discussion to show the effectiveness of our proposal. Finally, in section VI, 
we give our conclusions and directions for future research. 
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Figure 1: Overfitting problem for dendrite morphological neurons. Regularized model is less complex and has less testing 
error than non-regularized model. 


II. PREVIOUS WORK 


Morphological neurons were proposed by Davidson and Hummer in their seminal paper [5]; their computing capabilities 
were studied by Ritter and Sussner [6]. Taking into account that information processing occurs also in dendrites, not only in 
cell body of neurons [7], the dendrite morphological neurons were proposed as an extension in [8]. A key issue is their 
training; we need to determine automatically the number of dendrites and the dendrite weight values. Several training 
approaches have been proposed, refer for example to [8, 9, 10, 11, 12, 1]. The training method based on divide and conquer 
strategy [1] has shown to outperformed Ritter's training approach [8] and other classical learning models. However, as we 
have mentioned in section I, this training approach suffers from overfitting as we will show in section V. In this paper, we 
enhance this method to overcome overfitting; we also present a recursive way for its efficient implementation. For more 
applications of DMNs, the reader is referred to [13]. 


III. DENDRITE MORPHOLOGICAL NEURONS 


A DMN has shown to be useful for pattern classification. It segments the input space into hyperboxes of N dimensions. In 
this work, we consider that each dendrite generates only one hyperbox assigned to a particular class; one important feature is 
that there is no overlap among hyperboxes. The output y of a neuron (see Figure 2) is a scalar given by 


y = argmax;,(d,, x), (1) 


where n is the dendrite number, k is the class number, and d,,; is the scalar output of a dendrite given by 


Unk = min;(min(x-w” min W mai -x)), (2) 
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where x is the input vector, Win and Wmax are dendrite weight vectors. The min operations together check if x is inside the 
hyperbox limited by win and Wmax as the extreme points, refer to Figure 2. If da> 0, x is inside the hyperbox; if d,; = 0, x is 
somewhere in the hyperbox boundary; otherwise, it is outside. Note that the inner min operation in (2) compares elements of 
the same dimension between the two vectors, generating another vector, while the outer min; operation takes the minimum 
among all dimensions, generating a scalar. A good property of DMNs is that they can create complex nonlinear decisions 
boundaries that allow separating classes with only one neuron (see Figure 1), in contrast to classical perceptrons. To be 
useful, perceptrons require to be arranged into layers that increase the artificial neural complexity and DMNs require more 
dendrites. It is worth mentioning that if (1) produces several maximums, the argmax operation takes the first maximum as 
index class to which the input pattern is assigned. Qualitatively speaking, this occurs when is equidistant to more than one 
hyperbox. 


X2 
dng(x) <0 


argmaxy 





Figure 2: Dendrite morphological neuron and an example of a hyperbox in 2D generated by its dendrite weights. The 
hyperbox divides the input space for classification purposes. 


IV. DIVIDE AND CONQUER TRAINING WITH REGULARIZATION 


In this section, we extend the method in [1] by introducing regularization as a way to reduce overfitting obtaining a better 
performance as we will see in section V. Besides, we describe how the training method is implemented in a recursive way. 
The code and a demo of this training algorithm are online at [14]. 


Let as consider that we want to classify some patterns into N, classes. We have a training samples set represented as a 
matrix P € R*2"%" where N is the number of features and Orain is the number of training samples. The target class for each 
sample is contained in vector T € NS” where the membership class is given by a natural number. So we need a set of 
hyperboxes Listy that enclose the training samples with their corresponding class Listc as illustrated in Figure 3-(b). A 
hyperbox H is represented by its dendrite weights H=(Wmin Wmax). The training goal is to determine the number of hyperboxes 
and their weights that allow classifying an input pattern. 


Training consists on only two procedures shown in lines (1) and (2) in Algorithm 1. As can be appreciated, the algorithm 
begins by opening an initial hyperbox A, that encloses all the samples with a margin distance M respect to the data extremes. 
Next the divide and conquer strategy is executed in recursive way as shown in lines (4) to (17) in Algorithm 1. Then the 
algorithm chooses a training sample p to generate a sub-hyperbox H,,,, around it. Next it extracts the samples (P Hsub, T Hsub) 
from (P,T) that are enclosed in H,,,. A new level L of recursion executes again with these extracted samples. An example of 
this recursion process is provided in Figure 3-(a). 


The recursion divides Ho until one of the following two cases happen: 1) the percentage error Ev, in the hyperbox H is less 
or equal to an adjustable value Ep, or 2) the recursive level L plus one is greater than an adjustable value Ly. These adjustable 
values allow us to regularize the training, avoiding overfitting as well as generating complex models as we will describe in 
section V. The percentage error is defined as 


E% T LP node EP | (3) 


where P noae 18 set of training samples in P with the class of statistical mode. 
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At the end of the recursion process, the deepest hyperbox is assigned to the ruling class which is chosen by the statistical 
mode of T. The algorithm begins the recursive closing procedure by appending all generated sub-hyperboxes to Listy with 
their corresponding class (see lines (13) and (14)) in Algorithm 1. Finally, the algorithm simplifies the number of hyperboxes 
by joining the hyperboxes sharing the dimensions. 


Algorithm 1: This is the recursive algorithm that implements the regularized divide and conquer training for dendrite 
morphological neurons. 


Ho := generate initial hyperbox(P,M) 
(Listy , Listo) := DKC(Ho, P, T) 


(Listy , Listc) := D&C(H, P, T) 
if Es, <= Ey or L+1> Lo 
Listy := H 
Listc := statistical_mode(T) 
else 
while P is not empty 
Hsuw:= generate_subhyperbox(H, p) 
(Pru Trsup, P, 1):= extract _samples(Hyus, P, T) 
(LiStHsub, LiStcsu): = DE-C(Hsut, Psu, THsub) 
Listy := Listy U LiStHsub 
Listc := Listc U LiStCsub 
end 
(Listy, Listc) := join_hyperboxes(Listy, Listc) 


end 


Recursive assignment of class region 
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Figure 3: Divide and conquer training is explained. 
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V. EXPERIMENTS AND RESULTS 


In this section, we compare two regularization methods with different synthetic and real datasets. The results demonstrate the 
relevance of the proposed regularized training methods for DMNs. Furthermore, we discuss the advantages and 
disadvantages of each regularization method, trying to determine which the best is. The reader can reproduce the 
experimental results of this paper by using the online code provided at [14]. 


A. Synthetic and Real Datasets 


Regularized training methods are first applied to synthetic datasets with high overlapping. We have chosen datasets where 
overlapping is presented because overfitting is more relevant in this kind of problems. The first synthetic dataset is called A, 
and it is generated by two Gaussian distributions with standard deviation equal to 0.9. The first class is centered around (0, 
0); the second class is centered around (1, 1). The second synthetic dataset is called B and consist on three classes which 
follow a Gaussian distribution with standard deviation equal to 1.0. The classes centers are: (-1, -1), (1, 1), and (-1, 2). Figure 
4 shows the distribution of these datasets and the overlapping among the classes. 

















© class 2 
+ class 3 





Figure 4: Plotting of the synthetic datasets showing overlapping between classes; (a) for A dataset, and (b) for B dataset. 


We also use some real datasets to test the performance of the proposed regularized training methods. Most of these datasets 
were taken from the UCI Machine Learning Repository [15]. However, we also use MNIST [16] and CIFAR10 [17] datasets 
to have tasks with high dimensionality. We describe them briefly. The Iris dataset is a classical non-linearly separable 
problem with three types of iris plant and four describing features. The Liver dataset consists of detecting liver disorder (two 
classes) by means six features that relate blood tests and alcoholic drinking. The Glass dataset has the purpose to identify the 
glass type in crime scenes by means ten properties of glass. Ideally, the number of classes is seven, but no instances are 
provided for class number four in this dataset, refer to Figure 5). The Page Blocks dataset needs to classify the blocks of 
documents into five categories based on ten block geometrical features. The Letter Recognition dataset has 26 letters from 
different fonts which must be identified by 16 geometrical and statistical features. The Mice Protein expression dataset 
classifies the mice into eight classes based on features such as genotype, behavior and treatment. In this work, we only use 
the expression levels of 77 proteins as features for our experiments. Finally, we apply the proposed method to two image 
classification tasks taking the pixels as features (without intermediate feature extraction). The MNIST dataset is a classical 
recognition task for handwritten digit recognition (zero to nine) with image size of 28x28 pixels. The CIFAR10 requires 
recognizing ten among animals and vehicles by means of color images of 32x32 pixels. It is worth mentioning that in some of 
these datasets, we found duplicates; we deleted them for the experiments. Figure 5 shows the class distribution for each 
dataset. 
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Figure 5: Class distribution for each real dataset. In the case of Glass and Page Blocks datasets, data distribution is clearly not 
uniform. 


B. Regularization Curves 


In this subsection, we analyze the performance of morphological neurons trained according to the tolerated error £, and the 
depth limit Ly of the model. We measure performance in terms of the training error E;,,;,, the testing error Ees and the model 
complexity Nz/Qpain. This last quantity is defined as the ratio of the number of hyperboxes Ny by the number of training 
samples Qpain- If this ratio is equal to one, then the neuron uses a hyperbox for each training sample. In this extreme case, the 
model is very complex and presents no generalization. In contrast, if this ratio is close to zero, this means that the number of 
hyperboxes is much smaller than the number of training samples. Therefore, the model is simple and generalizes well. 
Ideally, we are looking for a morphological neuron with the smallest testing error Ees and with relatively few hyperboxes 
(Ni/Qtrain = 0), that is, a simple and well generalized learning model. 


We decided to vary one hyperparameter (Lọ or Eo) at the time to find out which one of regularization procedure is the most 
convenient: 1) regularization by the tolerated error; and 2) regularization by limiting the model depth. So regularization 
generates curves for two cases: 1) maintaining Ly=oo, varying the value of E, from zero to one, and 2) maintaining £,=0, we 
change the value of Ly from 0 to 11, where L¿=0 means that the initial hyperbox is not divided and a single dendrite is used in 
neuron (11 because after that value no changes are manifested in these datasets). Figures 6 and 7 show the results obtained 
for each database, for each of these cases. Margin M is set to 0.1 for all experiments. 


We have observed that the model complexity behavior is monotonic: complexity decreases as more tolerated error is allowed 
in the hyperboxes (Figure 6), and increases as more divisions are allowed in the hyperboxes (Figure 7). In contrast, the 
behavior of the training and testing errors is not monotonic. These errors increase and decrease depending on the specific 
dataset. For each dataset, in the first row of Figure 6 (except for the Iris case), the smallest testing error occurs somewhere 
when Ey>0, so the regularization improves the testing error; it also reduces model complexity. However, there is no value of 
Epo better than zero that can improve the testing error for the datasets as shown in the second row of Figure 6 and for the Iris 
case. The regularization by Æo is not useful in these last datasets. We observed equivalent behavior for regularization curves 
by Lo. In the first row in Figure 7 (except for the Iris case), the best value for Ly is less than the maximum value of Ly which 
is 11. This means that regularization improves the testing error and lowers model complexity. In the second row in Figure 7 
(and for the Iris case), limiting the model depth does not improve the testing error. 
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Figure 7: Regularization curves by Lo. 


Table I compares the performance of the two proposed regularized training methods in three cases for each dataset: 1) we fix 
E, = 0 and Lọ = œ; this case is equivalent to the original algorithm given in [1]; 2) we minimize the testing error by founding 
the best value of E, in the regularization curves in Figure 6; and 3) we do the same for Lọ, by minimizing the testing error in 
regularization curves in Figure 7. For the case of datasets: A, B, Liver disorders and Glass, the testing error is improved 
approximately by 4%. For the case of datasets: Iris, Page Blocks and Letter Recognition, no improvement in testing error was 
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obtained. However, in the last three cases, model complexity is reduced by our proposal. These results show that the 
proposed regularization works and improves the performance of trained morphological neurons. Besides, 1f we compare the 
performance obtained by tolerating errors versus limiting model depth, we can find that the first method tends to be better 
than the second one. This is because the first method can be tuned more finely. 


Nevertheless, we can see that regularization does not have any effect in the performance in the case of datasets with high 
dimensionality such as Mice Protein, MNIST and CIFAR10. This is due to the sparsity of the training samples in respect to 
the sub-hyperboxes generated by the initial hyperbox division. It is easy to see that the number of sub-hyperboxes increases 
exponentially 2" as N increases. So, the number of sub-hyperboxes is much greater than the number of training samples at 
high dimensionality. Consequently, when we apply divide and conquer training, almost a hyperbox for each training sample 
will be generated. The morphological neurons for these three datasets have overfitting and their learning model is too 
complex. For each dataset, the first row shows the results obtained by the original algorithm [1]; the second row is obtained 
by the best value of Eo and the last row is obtained by the best value of Ly. The best testing errors and complexities values are 
shown in bold. 


Table I: For each dataset, the first row shows the results obtained by the original algorithm [1]; the second row 
is obtained by the best value of Ey; and the last row is obtained by the best value of Ly. The best testing errors 
and complexities values are shown in bold. 
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VI. CONCLUSION 


In this paper, we presented two methods to regularize the training of dendrite morphological neurons. As we have seen, 
this allows reducing overfitting as well as the number of neuron dendrites. We observe that the best performance results were 
obtained by tolerating a maximum percentage error in each hyperbox. This can be useful for pattern classification at low 
dimensionality. However, when high dimensionality is presented none of the regularization methods reduces overfitting or 
lowers the number of hyperboxes. This remains an open issue for future investigation. 
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Wall-bot: the hexapod robot for inspection 


E. C. Orozco Magdaleno, E. Castillo Castañeda, F. A. Aguirre Cerrillo, J. Franco Acuña, K. H. 
Floreán Aquino, E. Francisco Agustín 


Abstract— This document presents the design, construction and control of the first version of WALL-BOT, a 
tele-operated hexapod robot for visual inspection in vertical surfaces. WALL-BOT is a bio-inspired prototype that 
consists in six open kinematics chains joined to a rigid chest and uniformly distributed, where the lead and rear 
legs are composed by four degrees of freedom (DOF) and the lateral legs by three DOF. The locomotion is designed 
for walking at vertical surfaces; therefore the hexapod has a suction system by suction cups. Since it is an 
inspection robot, WALL-BOT has a stereoscopic camera which is able to capture image and video in real time 
through a GUI (Graphical User Interface) developed in MATLAB. The robot is tele-operated from a gamepad and 
the programming algorithm is done in MATLAB. 


I. INTRODUCTION 


In robotics of inspection the type of locomotion is implemented depending on the conditions of the ground 
where the robot will displace, nevertheless, different techniques have been implemented about bio-inspired 
locomotion owing to their high efficiency. There are developed prototypes for locomotion in vertical surface 
that depending on the design conditions, they have been done different strategies and configurations that solve 
specifics issues. 


In relation to walking hexapod robots there are some works like <Behavior-based Modelling of Hexapod 
Locomotion> [1], that compares the walking insect and the six legs robots, explaining why they required a 
simultaneous control for eighteen actuators or more, taking in consideration the external conditions such as 
friction and the unpredictable slope. 


With the purpose to orient and regulate de oscillating motion, the simplest scheme that has been proposed 
for legs movement modelling corresponds to: three angles of the joints that describe the actual position, and, 
three angles for destination that describe the position of the end-effector in the support surface. 


Also, control algorithms have been implemented like that presented in <Complex-Order Dynamics in 
Hexapod Locomotion> [2], where the dynamics of interaction legs-ground in hexapod locomotion system is 
studied. 


In normal conditions, the walking period could be difficult to keep it. In that case, is better to use a walking 
mode that can move any leg at any moment. These walking sequences are known as free sequences, like the 
alternating tripod. This walk can reach the theoretical maximum speed and the optimal walk for stability [3]. In 
the Fig. 1 is shown an instant of time where the sequence of alternating tripod becomes clear, sampling the 
projection of the mass center from the support polygon. 
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Figure 1. Alternating tripod and the support polygon [3]. 


A. Vertical Surface Locomotion 


The bio-inspired climber robots that depend of adhesive systems for displacement, have become an 
essential tool for many tasks at industry, like the maintenance of the US navy aircraft carriers or the cleaning of 
high buildings [4], creating applications for the close future. In recent years, the research has mainly focused in 
the modelling of micro-scale adhesive phenomena and they have been developed experimental jobs with the 
final purpose to define the parameters of a specific model. 


This type of robots that depends of dry adhesives requires lay on their legs against the wall for increase the 
surface contact and thus maximizes the adhesion force. Inappropriate force redistribution can cause that the 
robot falls down from the wall. 


The robot's optimal position is when it sticks with just five legs in a wall. The first leg is the red one, and 
gets in movement phase [5]. The optimal position become when the mass center is near to the leads legs, and 
the rears legs are extended, Fig. 2. 
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Figure 2. Optimal position with dry adhesives [5]. 


Another performed work for vertical surface locomotion is <A Six-Legged Walking Climbing Robot to 
Perform Inspection Tasks on Vertical Surfaces> [6], which presents the kinematic analysis of a climbing robot 
called “Hex-piderix”, which has six legs with three degrees of freedom each one, also in the end of each leg has 
a suction cup for walking in vertical surfaces. In Fig. 3 is shown the prototype and in Fig. 4 the sequence of the 
locomotion used to displace the robot. 


Figure 3. Hex-piderix robot: Stability poligon [6]. 
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Figure 4. Hex-piderix robot: Tripod gait [6]. 


For this research is selected a suction system by suction cups and an alternating tripod locomotion 
sequence, offering to WALL-BOT a strong suction at the surface. The six legs robot walk has been design 
using a quasi-static model that takes into account the structure of the robot and the adhesive material features. 


Il. DESIGN AND CONSTRUCTION 


The main feature of WALL-BOT is its bio-inspired mobility, this means that it morphology has 
characteristics as a living being. In this case, the cockroach is taken as reference because it has ability to walk 
in inclined surface and can travel in any direction, including the transition in orthogonal surfaces [7]. The legs 
configuration of the robot and the degrees of freedom of each one have been made by watching the movement 
of the legs when the cockroach is moving, this is seen in Fig. 5. 





Figure 5. Legs configuration of a cockroach [7]. 


The configuration design consists in a six-chain open kinematics mechanism linked to a rigid chest having 
as characteristic that the lead legs and the rear legs <push-pull>, while the lateral legs help for the displacement 
and allow the alternating tripod locomotion sequence. The rear and lead legs are formed by four rotational 
joints (servomotors), where the first three are responsible to locate the suction cup at the space and the last joint 
guides it. The lateral legs are formed by three rotational joints, where the last one, as the other legs, guides the 
suction cup. Fig. 6 samples the schematic of the legs configuration, which are located in symmetrical form at 
the chest. 


Figure 6. Schematic of legs configuration [7]. 


A. Suction System 


The legs design is made for using a suction cup system. For this type of system is necessary to guarantee 
the parallel contact to the surface, as shown in Fig. 5. Thus, is necessary to guide the suction cup in any 
position of the path of locomotion, the responsible of this is a servomotor, which keeps the suction cup in 
parallel to surface at any time. 
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Figure 7. Suction cup in parallel to surface [7 





For the suction cup is necessary a pneumatic system providing compressed air to the legs of each tripod, so 
by this way the robot can walk in vertical surface. The pneumatic system is composed of six vacuum 
generators, six suction cups, two 3/2-way solenoid valves, and one air preparation unit, all the equipment is 
FESTO [7]. This system is divided in two parts, one part per tripod; see the distribution of the system in Fig. 8. 
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Figure 8. Pneumatic diagram of WALL-BOT’s subjection system [8]. 


B. CAD Modeling 


The design of the prototype was performed using SolidWorks, where the parts of the robot are modeled and 
then assembled. In this software is analyzed the possible collisions between the joints and links, and also is 
define the dimensions of each part of the robot for manufacturing. The alternating tripod locomotion sequence 
was simulated; Fig. 9 shows the two phases of the sequence. 


Group 1 Group 





Figure 9. Groups of legs for the alternating tripod sequence [7]. 


C. Electronics 


The controller is a 24-Channel Pololu Mini Maestro Servo Controller, which is specially designed to 
control servomotors. It has a USB interface and an internal command sequence control. The time resolution is 
0.25 us with a velocity and acceleration control function by frequency with a maximum range of 33 Hz in 
each channel. 
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The outputs of this module can be configured as PWM signals or as digital outputs. Thus, the digital 
outputs can send a signal to turn on the valves of the pneumatic system. To turn on the valves is implemented 
a circuit for each one with an optocoupler 4N35 and two transistors in Darlington configuration. A final 
transistor TIP31 supports a maximum current of one ampere. This circuit is shown in Fig. 10. The outputs of 
the controller are configured by MCC (Maestro Control Center). MCC is software of Pololu that allows 
controlling the servomotors connected in Mini Maestro, also MCC let configure the characteristics of the 
module. 
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Figure 10. Optocoupler circuit diagram for one valve [7]. 


The actuators are TURNIGY TGY-901D servomotors. These servomotors work with PWM signals and 
have 13 kilograms per centimeter of torque with an operating voltage range of 6.0 to 7.2 volts, and speed of 
6.54 to 7.48 rad/second. Also, they have metallic gears and ball-bearings. 


D. Construction 


A metallic box protects the controller and electronics; it is located at the front-central part of the chest and 
has a non-conducting cover to avoid damages in the electronic circuits. As inspection tool for the hexapod 
robot is mounted a stereoscopic camera over the box. Fig. 11 shows the hexapod robot. 





Figure 11. Hexapod robot. 


Ill. INVERSE KINEMATIC MODELLING 


For the robot’s motion is necessary to analyze the inverse kinematics of each joint and define the position 
equations. The representation of the hexapod robot legs and their reference system is shown in Fig. 12, it can 
be seen that the elements that hold the suction cup have a triangular form. The real measures in millimeters of 
each link are shown at Table I. 
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Figure 12. Representation the joints of the hexapod robot and their reference system [9]. 


TABLE L MEASURES OF THE LINKS IN EACH JOINT [9]. 


Leg LI L2 L3 a h 
(mm) (mm) (mm) (mm) (mm) 
781 780 785 275 660 
765 520 NA 300 680 
791 7713 772 297 66l 
779 780 780 310 660 
780 527 N/A 300 680 
780 772 773 311 660 


AIN RAJ UIN m 


For the kinematic analysis is considered that each joint is independent. At Fig. 13 is shown the coordinate 
axis system for the front and rear legs (1, 3, 4 and 6), as well as the angles formed by the links. 


(PLP PB) 











c) 


x 


Figure 13. Coordinate axis system for front and rear legs: a) XYZ plane view , b) XZ plane view, c) XY plane view [9]. 


By geometrical considerations, equations (1) to (13) are deduced, which determine the value of actuator’s 
angles. 
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For lateral legs (1 y 2), the coordinate axis system and the angles formed by the links are shown in Fig. 14. 








A) 





Figure 14. Coordinate axis system for lateral legs: a) XYZ plane view , b) XZ plane view, c) XY plane view [9]. 
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The value of the angles is determinate with equations (14) to (18), which are obtained by geometric 
considerations. 


P 
di = tan" (2) (14) 
Py 


R= Den eaea (15) 
D = |R? +P? (16) 





P, +h 
q2 = tan”! ( ) (17) 
R 
L +h? — D? 
= —1 18 
qs = cos Gores T ) (18) 


IV. PATH PLANNING 


The paths that the joints will follow are planned for a forward locomotion in straight line by the kinematic 
modelling developed. 


A. Lateral Legs 


The paths in Fig. 15 are selected for lateral legs, where the suction cup follows a rectangular path viewed 
from XZ plane and a circular path viewed from the XY plane. The arc formed by this path is too small that 
behaves as a straight line. 


The path can be divided in two parts: the first one (blue path) is used to hold the suction cup in the surface 
and achieve the robot to displace along it, and the second one (red path) to take off the suction cup and locate it 
again in the initial position to restart the cycle, as is seen in Fig. 15. This path is the same for leg 1 and 2. 








Figure 15. Lateral legs path: a) Rectangular in XZ plane , b) Circular in XY plane [9]. 


B. Lead and Rear Legs 


The selected path for front locomotion is in pentagonal form, this viewed from XZ plane, Fig 16 a), and 
straight line viewed from XY plane as in Fig 16 b). This path allows to do a straight line walk, while the 
pentagonal form allows to sync up the properly way to sticking and unsticking the suction cup in each step. 
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Figure 16. Rear legs path: a) Pentagonal in XZ plane, b) Straight line in XY plane [9]. 


In Fig. 16 is shown the path for the leg 3 and 4 (rear legs). As is shown, the upper part of the pentagon (red 
points) describes the path that joints follows to locate the suction cup, while the blue pointed path describes the 
path of the legs that put the suction cup in contact with the surface and the displacement along it once the 
suction cup is held. 


For lead legs (1 and 6), the path is shown in Fig. 17. It can be seen that the upper part of the pentagon (blue 
pints) describes the path that joints follows to locate the suction cup, while the red pointed path describes the 
path of the legs that put the suction cup in contact with the surface and the displacement along it once the 
suction cup is held. 


= 





Figure 17. Lead legs path: a) Pentagonal in XZ plane, b) Straght line in XY plane [9]. 


V. PROGRAMMING AND CONTROL OF LOCOMOTION 


The programming of the locomotion algorithm is done in MATLAB and it is divided in a main program 
and two subprograms. The main program controls the locomotion sequence from a gamepad, generating a tele- 
operation of the hexapod robot. The first subprogram calculates the inverse kinematics for a path of two steps, 
obtaining the value of the angles for all the joints. The second subprogram turns the angles from the inverse 
kinematics in to PWM signals for each position of the servos, and makes a serial communication format. 


A. Main Program 


This program (P1.m file) allows to tele-operate the hexapod robot using a JOINET gamepad. This gamepad 
has twelve buttons, in Fig. 18 is sample it distribution. Starting the program the buttons of the gamepad are 
read from de USB port of the PC. At pressing the START button the robot takes an initial position for being 
located in the wall, see Fig. 19, then the program waits the left joystick to be moved forward to start the 
locomotion. 


The locomotion is divided in two steps, which means that every time the joystick is moving forward the 
robot takes a step, and if it is maintained, the robot takes a continuous march until the joystick is no longer 
pressed. It is important to mention that the program ensures complete steps and cannot fall down when the 
joystick is no longer pressed. To finish the locomotion is necessary to press the SELECT button and then press 
the button 1 to turn off the suction pneumatic system to take the robot from the wall. 
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Figure 19. Robot's initial position. 


B. Inverse Kinematic Subprogram 


A path cycle is equal to two steps, so the general path consists in the repetition of this pattern. The path 
cycle has 180 via points, thus one step has 90 via points. In accordance with the paths previously proposed, 
there are calculated 90 different angle values for each one of the 22 servomotors for each step (CI. m file). 


There are calculated 90 different angles to take the robot from the position 1 to the position 2, and another 
90 different angles to take the robot from the position 2 to the position 1, see Fig. 20. The result of this is a 
matrix of 180 values of different angles for each joint (matrix of 180X22). The angles are calculated with (1) to 


(18) of inverse kinematic. 





Position 1 Position 2 


Figure 20. Main positions of the robot [9]. 


C. PWM Signals Conversion Subprogram 


This subprogram (d2mcc.m file) obtains the pulse width in microseconds (us) of the PWM signal that is 
necessary to take a servomotor to the angular position defined by inverse kinematic. Also, this subprogram 
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makes a format for serial communication with the controller. The conversion of the angular positions to PWM 
signals is done by (19): 


1000|us 
pwm = +O a +b (19) 


Where q is the angular position to convert, PWM is the value of the pulse width in us, b is the pulse width 


in us corresponding to 0 within the angular operating range. The pending + — lus) 


the PWM signal which it is working (20 Hz). 


is acommon relation from 


0° 


The lineal relation for the conversion and the sign of the pending is shown in Fig. 21. This conversion is 
done for the 180 via points, a path cycle, of each one of the servomotors. The results are save in a matrix. The 
sending of these signals to the control card requires a serial communication protocol defined by the 
manufacturer. 


a) 






' 
' 
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Figure 21. Conversion of angles to PWM signals: a) Positive pending, b) negative pending [9]. 


D. Communication Protocol 


The Pololu MCC card generates PWM signals and sends it to the servo channels. The communication 
protocol is described below. 


Orki nue disp,0x17,2m_canajes, canal_inicial PWM1_LB,PWM1 HD ;PWM2_ LB PWM? ED... 


The first command byte OxAA (170 in decimal) defines the band rate of the communication. Immediately is the 
number of the device, the device number for this controller is 12. The next command byte is Ox1F (31 in 
decimal) and defines the script of the position of each servomotor, then the number of channels to use, for this 
case are 22, the starting channel, 0 in this case, and finally the wanted position of each servomotor expressed in 
PWM signals. The signal value in us is not usually sent in just one byte, so for this the signal value is 
multiplied by 4 and divided in low byte (LB) and high byte (HB). From the command signal of MATLAB is 
possible to send the string that defines the serial communication protocol by the next form: 
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iwrite(s2,[170,12,31,22,0,s1gna11_LB,signa11_HB]*uint8”); 


VI. IMAGE ACQUISITION GUI 


To capture image and video it has been developed a GUI (Graphical User Interface) in MATLAB. This 
GUI takes image and video in real time and stores 1t in JPG and AVI format respectively. The acquisition 1s 
performed by the “Image Acquisition Toolbox” of MATLAB. 


The video is capture at 40 fps (frames per second), this quantity was defined by testing the speed of the 
image acquisition, and 40 fps was the best. It is important to mention that although the cam is 3D, the image 
and video capture is performed in 2D format. The camera is a WEC-360 3D of SOMIKON with a maximum 
resolution of 640X480 per each lens, Fig. 22. 





Figure 22. Main positions of the robot [10]. 


The GUI (Ad_Ima.m file) uses just one lens because both lens are practically at the same height and capture 
the same image. This GUI has the next characteristics: 
e Capacity to capture images and videos in real time. 


e Capacity to take continuous videos of 30 seconds each one, cleaning the flash memory of MATLAB at 
the end of each video. NOTE: This is because MATLAB does not support a long image acquisition. 


e Capacity to take any number of images and videos. 

e Capture mode selection (image or video), simple and fast. 

e Simple interface, with indicators of number of videos and the recording time. 

e Buttons for: start cam, finish cam, capture image, start recording video and finish recording video. 


e Enable and disable of buttons to protect the GUI of a wrong use of them, for example, enable the 
recording buttons when the capture mode is on image, and vice versa. 


In Fig. 23 is shown the Image Acquisition GUI and it can be seen the parts of it. 
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Figure 23. Image acquisition GUI [8]. 


VI. EXPERIMENTAL VALIDATION 


As experimental validation of this research, performed a visual inspection was performed with the hexapod 
robot. To perform the inspection is necessary two computers and follow the next instructions: 


1 
2 
3. 
4 


6 
de 
8 
9 


Open the valve of compressed air. 
Open MATLAB in both computers. 
Connect the USB cable of the Mini Maestro card to the PC 1, and verify the COM number. 


. Connect the USB cable of the stereo camera to the PC 2, and verify that the resolution programmed 


match with the resolution available on MATLAB (the resolution can be different depending of the 
MATLAB version). 


Connect the USB cable of the gamepad to the PC 1 and press the ANALOG button, wait for the red led 
to turns on. 


Open MCC on PC 1. 

Ensure that servos be disable in the STATUS window. 
Open in PC1 P1.m, d2mcc.m and CL.m. 
Open in PC 2 Ad Ima.m. 


10. Turn on the power supplies for the servomotors at 7 volts and for the pneumatic system ay 24 volts. 


11.Run Pl.m, to take the robot to the initial position is necessary to press the START button of the 


gamepad. NOTE: If is desired to cancel the operation press the SELECT button. 


12. Place the robot on the wall. 


13. Run Ad_Ima.m to start the GUI and start the cam. 


14. Move the left joystick forward to start locomotion. If is desired to perform continues locomotion, just 


maintain forward the joystick. 


15. To capture image or video, is just necessary to press the corresponding buttons of the GUI. 


16. Press the SELECT button to finish locomotion. 


17. Press button 1 to turn off the pneumatic system and can take down the robot. 


18. Turn off the power supplies. 


30 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 3, páginas 18 - 32. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


Following the previous sequence, vertical walking is performed with the hexapod robot along a wall of 2.5 
meters of height (approximately) in the Laboratory of Mechatronics of the Research Center in Applied Science 
and Advanced Technology Unit Queretaro from the IPN. Fig. 24 shows some pictures of WALL-BOT during 
locomotion. 





Figure 24. Vertical walking of WALL-BOT while is doing a visual inspection [8]. 


During the inspection were captured three videos. The videos and images captured with the GUI are stored 
in the folder of MATLAB where programming is running. At the Fig. 25 are shown the results from the image 
acquisition during the inspection. 
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Figure 25. GUI during inspection [8]. 
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When the videos are in a playlist, for watching the inspection continuously, it can be appreciated a little 
lapse where the image lose the continuity (one second approximately). This lapse is because program has to 
store the video and clean the flash memory of MATLAB to start recording a new video. 


VHI. CONCLUSION 


This paper shows the design, construction, control and experimental validation of the first version of 
WALL-BOT. The developed project allows a viable and safe alternative for the people that works in dangerous 
high places, by this way they can do a visual inspection before climbing to perform tasks thus allowing to see 1f 
the work zone is safe or if is necessary a special equipment (suit for chemical spills, mask, etc.) and the 
necessary tools to work. All these tasks are simple and easy to do for the operator; 1t is just necessary two 
computers to run the programs. 


The tele-operation through the gamepad is intuitive and does not require specialized training, so that any 
person can use this robot. With the above is given a big step in the handling of the robot, because in 
comparison with the automated systems the operator should has a special training to generate the paths that the 
robot has to follow, all this based in the inspection zone. 
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Effects of a reconfiguration on kinematic performance of a delta- 
type parallel robot 


Albert L. Balmaceda-Santamaría, Eduardo Castillo-Castañeda 


Abstract— This paper presents a new reconfiguration of a Delta-type parallel robot. The proposed reconfigurable mechanism, 
whose patent is in process, has a fixed platform comprising of a fixed element and mobile elements, which modify the size and 
shape thereof. Furthermore, the operational Cartesian workspace is increased thanks to the reconfiguration when it is com-pared 
with that of the original version. The input-output equation of the velocity of the reconfigurable mechanism is obtained by 
resorting to reciprocal-screw theory and the evident singular configurations are analyzed. Finally, the kinematic performance of 
the reconfigurable mechanism is presented, based on the calculation of a performance index. The results indicate that an 
improvement of the kinematic performance of the new robot is obtained, when this is compared with the performance of a Delta- 
type robot. 


I. INTRODUCTION 


The flexible manufacturing system is a highly versatile production system, which can adapt to different requirements of the 
market. Reconfigurable manufacturing parallel manipulators can quickly adjust their structure according to a specific task, 
which is desirable to satisfy market needs and suitable for flexible manufacturing systems. 


In robotics the reconfiguration concept was presented by [1] as the change of the characteristics of the robot in operation, 
distinguished in two types: static and dynamic. The main approaches that have been proposed for reconfiguration of parallel 
mechanisms as the Gough-Stewart platform are modular and variable geometry designs, see for instance [2-4]. 


A modular manipulator consists of a set of modules that can be assembled into robots with different attributes. The 
modularity has been used recursively in parallel manipulators by [5-8]. 


The reconfiguration of parallel manipulators using variable geometry consists of changing some dimensions of the robot 
with the purpose to generate new postures upon the same parallel manipulator. A double planar parallel reconfigurable 
manipulator presented by [9], the reconfigurable platform based on the Stewart-Gough of [10], a reconfigurable parallel 
mechanism with an adjustable base designed by [11] and a new family of reconfigurable parallel mechanisms [12], are some 
which may be mentioned. 


Furthermore, many authors (including some aforementioned) have used the redundancy produced sometimes by 
reconfigurations of the parallel robots for improving characteristics such as: stiffness [13-15], force [16-17], accuracy [18], 
increased workspace and singularity-free workspace [4] y [19-22], as well as performance indices like manipulability, 
condition number, global condition, dexterity and global dexterity [23-26]. 


It is evident that reconfigurable parallel manipulators are a well-documented problem, since the reconfigurability remains 
today a challenge in the parallel robotic field, mainly in issues of occupy large structural spaces. In the case of the mechanisms 
aforementioned, they have a high level mechanical complexity in their structures and hence very expensive to be made. 


In this paper a new reconfiguration of a 3-DOF Delta-type parallel robot, based on the concept of variable geometry is 
present-ed. The base robot used for the reconfiguration proposal, named Parallix LKF-2040, was designed as a didactic version 
at National Polytechnic Institute (IPN) in CICATA, Mexico [27]. The reconfiguration strategy is highly versatile, very simple 
and it is capable to return to the original configuration and mechanical characteristics of the Parallix LKF-2040. 


The redundancy generated in the manipulator by the reconfiguration proposal, is used to improve the kinematic 
performance of the robot, by calculating a performance index along prescribed trajectories. 


II. DESCRIPTION OF THE RECONFIGURABLE ROBOT 


The Parallix LKF-2040 robot is a translational manipulator that was developed at IPN - CICATA. This manipulator is very 
used for teaching purposes, thanks to that it has an open architecture [27]. 


The Parallix robot comprises 3 stationary motors disposed angularly on the robot base through brackets. The motor axes 
are coupled to a kinematic chain at the bracket level. This mechanism has a structure of the well-known Delta robot, however 
the mechanism of Fig. 1 is a 3-RUU robot. 


Albert L. Balmaceda-Santamaria, Universidad Nacional de Ingenieria, Managua, Nicaragua. (e-mail: albert.balmaceda@gmail.com). 
Eduardo Castillo-Castañeda, Instituto Politécnico Nacional, Centro de Investigación en Ciencia Aplicada y Tecnologia Avanzada, Unidad Querétaro, 
Querétaro, México. 
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Figure 1. Current configuration of the robot Parallix 
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A. Reconfiguration proposal 


The main variable that significantly influences in the Parallix workspace is the diameter of the fixed platform [28], since 
the diameter length directly impacts on workspace features, mechanical simplicity and number of actuators required for the 
reconfiguration. The following requirements were considered to implement the reconfiguration of Parallix robot: it must be 
mechanically simple, without adding weight and/or actuators into the kinematic chains, be able to change the entire workspace 
without modifying the lengths of links, increasing the versatility without to couple or uncouple links into mechanism and 
minimizing the structural space occupied by the robot. In Fig. 2, a conceptual design of reconfigurable Parallix LKF-2040 
robot that fulfills the above conditions is shown. 


Figure 2. Proposed reconfigurable mechanism 





The reconfigurable manipulator of Fig. 2 comprises of a reconfigurable fixed platform (1) with a fixed element (2) and 
three mobile elements in form of framing square (2a, 2b, 2c) moved by the motors (3a, 3b, 3c). Such motors move the framing 
squares with simultaneous or independent movements between each other. 


Each framing square modifies the radius and height between the axes of the motors (4a, 4b, 4c) and the center of the fixed 
element (2). It should be note that this reconfiguration is highly versatile, since the mechanism can be reconfigured also with 
each of the framing squares with decoupled movements from the rest of the mechanism and be able to return to the original 
configuration and mechanical characteristics of the Parallix LKF-2040 robot. In Fig. 3, the geometrical parameters of the 
reconfigurable manipulator Parallix are shown. 
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Figure 3. Geometrical parameters of the reconfigurable mechanism 


Fixed platform 





III. KINEMATIC ANALYSIS 


A. Direct displacement analysis 


Direct displacement analysis consists of finding the location of the moving platform of coordinates P = (Px Py Pz), given 
the generalized coordinates of the manipulator a;. In what follows, the direct displacement analysis is performed based on the 
method presented by [29,33]. 


Now, let X,Y,Z, be the fixed reference system in the center of the fixed platform of the manipulator. The coordinates of the 
points F; = (Fx; Fy; Fz;), A; = (Ax; Ay; Azi) y B; = (Bx; By; Bz;) are calculated by projections as follows 


F;=|[Rycos(0,) 0 Rysin(0;)] 
A; = [R, cos(a4;)cos(6;)+Fx; R,sin(ag) R,cos(ag)cos(0;)+Fz;| 
B; = [La cos(a;)cos(0;)+Ax; By; La cos(a;)sin(@;)+Az;| 


where i=1,2,3; Ry is the distance from the fixed reference system to each point F; 6; is the orientation angle of each kinematic 
chain. Evidently By;=La sin(a;)+ Ay; is equal for all kinematic chain. 


Now, consider that the moving platform is an equilateral triangle C;C>C; of side r and center P. Therefore, consider C,=(X 
Y Z), then coordinates C, and C; can be formulated according to C; as follows 


C2 3=(Xtr cos(0, 3) Y Zr sin(0, 3)) (1) 
therein 0, ; is the orientation angle of kinematic chains 2 and 3, respectively. 


In order to calculate the coordinates of X, Y and Z consider the following closure equations (C; - B,)*(C, - B)=Lb that 
generate 
Xot Vat Ly + Ky X+KiY+K 32+ Kjig=0 (2) 


In this way, K,(j=1,2,3) are obtained according to the parameters and generalized coordinates of the mechanism, e.g., K¡¡=- 
2Bx,, K\2=-2By,, K,3=-2Bz,, Ku=Bz+By¡+Bx/-LÚ”. .., etc. Furthermore following some computations on (2), the unknowns 
X and Y can be expressed in terms of Z as follows 


X=W,Z+W,, Y=W3Z+W, (3) 


where the coefficients W1,...,W4 are calculated according to the coefficients K;, e.g., 


_ KaKa - K2)+ Ko3[K;> - K3 )+ Ki3(K32 - Ka) 


W = 
i is —K,))+ K¡¡(K3, —K22)+ K3 (Ko) -K;,) 





(4) 


Finally, substituting (3) in any of (2) produces a second-order equation in the unknown Z as follows 
aZ *+bZ+c=0 (5) 


where 
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a=1+ W’ +W 
DK Wi +2 W Wz +K 3+2W3W4+K W) 
C=K W+ Wy +Wy +K gt KW 


Equation (5) indicates that moving platform can reach two different poses. Finally, the center of moving platform P is 
calculated using (6) as follows 


P=(X + 1/3 (cos(0,)+cos(03)) Y Z+r/3 (sin(@2)+sin(93)) (6) 


B. Velocity analysis 


Velocity analysis involves determining the velocity state of the moving platform with respect to the fixed platform [29], 


when the joint rates a@,,=q,, and a, =q; are given. 


Let V=[0,v]’ be the velocity state of the moving platform as observed form the fixed platform, where v is the velocity 


vector of any point on the moving platform. The velocity state V may be expressed in screw form through the limbs of the 
mechanism as follows 


dB + 4,19) +, 0 + 0 8 +, 00 8 + ¿08 =V (7) 


therein į denote the i-th kinematic chain. In order to obtain an input-output velocity equation of the reconfigurable manipulator, 
consider that L; =[/x; ly; lz; Lx; Ly; Lz;| is a line in Pliicker coordinates, which passes through the points B; and C; (Fig. 3), 
reciprocal to all the screws in the same limb, excepting the screws associated to the active joints. Therefore, the systematic 
application of the Klein form, which is denoted as (fx; +} of the line L; to both sides of (7) and reducing terms, yields the input- 
output velocity equation as 


v=A"(B'4, +Bq) (8) 


therein A=[1x; ly; lz" is the manipulator Jacobian matrix, while q, = ld. ġo Ga) and q=lg, 9, q,] are the first-order 
generalized coordinates of the mechanism. The passive Jacobian are B'= diag|}°$' A i $; -L,} e iL \ and 
B= diag|{'$?:L,} CA o Hl i 


C. Evident singular configurations 


The singular configurations or singularities according to Refs. [30] and [31], can be deduced from (8). Such configurations 
are distinct for the fixed platform and the rest of the mechanism, since they are uncoupled mechanisms. However, when there 
exist combined singularities between these two mechanisms, then the reconfigurable manipulator will be in a fully singular 
pose. 


In this concern, singularities of the Delta-type robot occurs when: 


1. If det(A)=0, then the links Lb are collinear or parallels. In these configurations the moving platform gains degrees of 
freedom. 


2. If det(B)=0, then the links La are completely folded or unfolded. In such configurations the mobile platform loses 
degrees of freedom. 


3. If det(A)=0 and det(B)=0, then the fixed platform and the moving platform are coplanar, e.g. when the moving platform 
has an identical geometry to that of the fixed platform and the limbs are vertical. 


It should be noted that the singularity locus remains the same as a one Delta-type robot. This condition shows that the 
reconfiguration strategy does not drastically affects the structure of this parallel robot. It is also important to note that the 
Delta-type mechanism is capable to avoid singularities by using the redundancy of the reconfigurable robot, which is an 
additional advantage of the proposed strategy in this paper. 


On the other hand, the fixed platform that is reconfigurable, has its own singular configurations, which may occur when 
det(B’)=0, e.g. when the mobile elements are folded or unfolded. 


IV, NUMERICAL EXAMPLE 


In this section, a numerical example is provided to show that by redundancy it is possible to obtain customized solutions of the 
kinematic performance. For this aim, the compute of the condition number is used as a performance index throughout defined 
trajectories (See Fig. 5). 


Three Cartesian trajectories of the center P of the moving platform are generated by solving the direct displacement 
analysis [29], considering a; 3(t)=0.25sin(t) and a,(t)=0.25cos(t) with an interval for time tof0 < t < 27. The configurations of 
0.4; for each trajectory are arbitrarily selected, shown in Table 1 as follows 


36 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 4, páginas 33 - 40. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 














TABLE I. ANGULAR CONFIGURATION FOR EACH TRAJECTORY 
Trajectory 1 (blue color) Oaj= -15° O49= 30° @s2= -70° 
Trajectory 2 (red color) a417 -35° 0149 40° 049 60° 
Trajectory 3 (black color) a47 45° 049 -45° 049-290 














The link lengths used are: La =0.2, Lb =0.4, r=0.05, Ry=0.05 and 0 < R, < 0.1618, thanks to the reconfigurations effects. 
The direction of rotation axes of the active joints are defined by û; =-k, û, = -0.866f +0.5k and ús =0.8661+0.5 k . 


Figure 4. Trajectories of the center P at different values of a4) 
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The trajectories in Fig. 4 are performed in different planes and are considering the three degrees of freedom of the 
mechanism. 


V. RECONFIGURATION EFFECTS ON THE ROBOT PERFORMANCE 


In [32] is defined that the condition number describes the accuracy/dexterity and the closeness to a singular configuration 
of a parallel manipulator. For this reason, many authors (as some of those aforementioned) have used the condition number as 
a performance index of a Delta-type robot. In our case, the results of this performance index are improved by using the 
redundancy generated by the proposed reconfiguration. The condition number is defined as 


ad o) 
where J is the manipulator Jacobian matrix, obtained from Eq. (4) as follows 

v=(A"B)q=Jq (10) 
since we here use the matrix J of the well-known architecture of the Delta-type robot, in order to demonstrate that it is possible 
to enhance its kinematic performance thanks to the redundancy of the reconfigurable mechanism. 


It is important to define that the first term of Eq. (8) depends on q.,, as well as k(a4;) given that the best solution of k is 


computationally obtained by sweeping all possible combinations of a4 in a range of 90° < a4; < -90° and seeking locally for 
each one of the trajectory points. Therefore the first term of Eq. (8) vanishes. 


To have a better appreciation of the condition number, the inverse k’ will be used, since it has a range between 0 < k’ < 1. 
If k' = 0 indicates that the Jacobian matrix is not invertible, hence the manipulator cannot generate velocities in some 
directions which is called, to be at a singular configuration [31]. When k’ = 1 the manipulator is capable of generating 
velocities in any direction, in other words to be in an isotropic pose [32]. 


The best results of k* are obtained for the 181 points of each trajectory by using the redundancy of the reconfigurable robot 
and they are compared with the result of k' obtained with the original configuration of the Delta-type robot (see Fig. 5 — Fig. 
7). 
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Figure 5. Values of k* for the first trajectory (blue circle) of Fig. 5 
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Figures 5 — 7 show a similar behavior of the kinematic performance of the two mechanisms in each of the trajectories. 
Nonetheless, the condition number of the Parallix robot is almost always less than 0.2 in each trajectory. 


It is evident that in Fig. 5, the kinematic performance of Delta-type robot is slightly improved from 0.2 — 0.3 according to 
the condition number. However, along the entire trajectory, the reconfiguration strategy 1s better than the original configuration 
of the Delta-type robot. 


An interesting case in the red trajectory is shown in Fig. 6. Note that from trajectory points 2 — 66, the Delta-type robot 
cannot perform its trajectory. In other words, along this section this robot would be in a singularity. On the other hand, the 
reconfigurable mechanism can easily escape from such singularities, therefore its performance is better than Delta-type robot 
along the entire trajectory. It should be noted that the improvement is highly significant, thanks to redundancy generated by the 
proposed reconfiguration strategy. 


Figure 6. Values of k* for the second trajectory (red circle) of Fig. 5 
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It is easy to notice that in Fig. 7, a very important improvement occurs in the performance between the black trajectory 
points 20 — 60, since the reconfigurable robot reaches a maximum value k* = 0.4583 compared to the original mechanism that 
reaches a maximum one k* = 0.1742. 


In each point of the prescribed trajectories, the reconfigurable mechanism obtains values of k* nearest to 1, which could not 
be achieved only with the Delta-type robot, namely when ay; = 0. 
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Figure 7. Values of k* of the third trajectory (black circle) of Fig. 5 
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Therefore, since the results of the condition number are improved in each trajectory thanks to the reconfiguration, all the 
other performance indices that depend on the manipulator Jacobian matrix, e.g.: Manipulability index, Minimum singular 
value, Global conditioning index, Global manipulability index and even the stiffness, are also improved. 


In fact, the reconfiguration proposal can be used in flexible manufacturing systems, since it is considered to be able to 
customize its kinematic performance according to a specific task. 


VI. CONCLUSION 


Many reconfiguration strategies of parallel manipulators have been proposed in the robotic area (as aforementioned). 
However, the reconfigurability in parallel robots is still a challenge nowadays, since most of such reconfiguration strategies 
have a high level of mechanical complexity in their structures and hence they are very expensive to be made. In addition, a 
very limited number of authors have proposed reconfigurable Delta robots. 

In this paper, a new reconfiguration of a Delta-type parallel robot is proposed. This reconfiguration strategy proposed here 
is highly versatile, very simple and it can be able to return to the original configuration and mechanical characteristics of a 
Delta-type robot. 

The reconfiguration proposal, which is now in patenting process at IMPI-Mexico, consists of a fixed platform comprised 
by a fixed element and mobile elements, which simultaneously can modify the dimensions and shape of such fixed platform. 

It is very important to note that it is could be considered that the use of the 3 additional actuators (3a, 3b, 3c in Fig. 2) in 
the reconfiguration proposal, is an inefficient and expensive application. Nevertheless, thanks to the reconfiguration proposal, 
significant advantages can be obtained with respect to a Delta-type parallel robot. 

The kinematic analysis is reported by resorting to reciprocal-screw theory and the evident singular configurations are also 
analyzed. Customized solutions of the robot kinematic performance can be obtained by using the redundancy produced by the 
reconfiguration. Additional advantages such as: increased workspace and to avoid singular configurations, can be obtained. 

A numerical example of effects of the reconfiguration on the manipulator performance is provided. The computation of the 
best condition number is obtained, according to prescribed trajectories to different heights of the robot workspace. The results 
show that by using the redundancy, the condition number is enhanced in each trajectory. Accordingly, all the performance 
indices that depend on the Jacobian matrix are also improved. 
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Robot bipedo antropométrico con dieciocho 
grados de libertad. Enfoque mecánico. 


D. Alvarado Rivera, L. G Corona Ramírez, J. S. Muñoz Reina 


Resumen: El objetivo principal de este trabajo es presentar; el análisis estructural de la construcción de un prototipo de robot 
humanoide, la longitud de los eslabones y la ubicación de las articulaciones basándose en la antropometría del cuerpo humano, el 
diseño de los eslabones se realiza en función del análisis de esfuerzos que se presentan en la composición del robot y el par al que se 
someten los mismos, como punto final se realiza un análisis cinemático utilizando la metodología de Denavit-Hartenberg, con el fin de 
conocer la posición y orientación de los eslabones que conforman al robot. 


I. INTRODUCCIÓN 


La robótica en nuestro tiempo ha tenido un gran avance en los recientes años, es por ello que las nuevas generaciones buscan 
desarrollar metodologías para la creación de robots, en su mayoría a estos se les atribuyen tareas de servicio las cuales conllevan 
el riesgo de la vida de un individuo. 


Este trabajo presenta, el diseño de un robot bípedo por medio de análisis de esfuerzos, el cual se comunica con un sistema 
externo que mide y envía la posición de los ángulos existentes en las articulaciones de un individuo durante su marcha. Uno de 
los principales retos es obtener un diseño funcional de un robot bipedo que cuente con 18 grados de libertad. 


Al gestionar este tipo de robots principalmente se busca una adecuada morfología, para esto se determinó la longitud, la 
composición estructural de cada elemento que compone al robot y los ángulos de trabajo de los elementos que dan sostén a cada 
articulación, asemejando así la constitución anatómica del cuerpo humano desde los pies hasta los brazos. 


Utilizando los parámetros Denavit-Hartenberg es posible predecir el comportamiento cinemático del bípedo debido a que se 
obtienen las trayectorias y orientación final de los eslabones del robot, con estos datos se obtiene la relación existente entre 
coordenadas articulares y cartesianas. 


II. ARTICULACIONES PRESENTES EN EL ROBOT 


Usualmente los bípedos no presentan los mismos movimientos en comparación a los de un ser humano, basta con mencionar 
que la articulación de la mano podría modelarse como un robot esférico, de tal manera para imitar la gran mayoría de los 
movimientos que realiza la muñeca serían necesarios tres motores encargados de generar estos movimientos. Quizá para un robot 
da tamaño real no causaría problema utilizar esos actuadores, pero al llevarlo a menor escala la dificultad aumenta 
considerablemente, por lo que para este diseño del humanoide se busca que cuente con las articulaciones más representativas del 
cuerpo humano. 


Tomando en cuenta lo anterior podemos destacar los movimientos más notorios al caminar, como son la oscilación que existe 
en los brazos, la inclinación del dorso, y la convergencia de las actividades del miembro inferior. La marcha humana se divide 
en dos fases repetitivas; la primera es la fase portante el inicio del clico, que a su vez se divide en tres periodos 1. Apoyo de los 
dos miembros inferiores, 2. Apoyo de un solo miembro y 3. Apoyo de los dos miembros inferiores, y la segunda fase 
denominada oscilante, en la Fig. 1, se aprecian las dos etapas, así como el porcentaje que cada una representa. 
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Gait Cycle 


Stance ; Swing 
0 50 100 


Figura.1. Ciclo de la marcha del humano [1] 


III. BIÓMECANICA DE LAS ARTICULACIONES 


La estructura mecánica del cuerpo humano se analiza como una serie eslabones interconectados, cuyas uniones generan 
movimientos en los miembros del ser humano, de esta manera se presenta en la Tabla 1 y 2 los rangos angulares utilizados para 
el diseño del robot bípedo. 


TABLA 1: ARTICULACIONES PRESENTADAS EN EL PLANO FRONTAL Y SAGITAL 


Inclinación 


Hombro Flexión 0°-180° 
Extension 0°-50° 
Aduccion 0°-30° 
Abducción 0°-180° 


0°-145° 


Cadera Flexión 0°-120° 
Extensión 0°-15° 
Aducción 0°-20° 
Abducción 0°-30° 
Extensión 0°-5° 
Extensión 0°-20° 


TABLA 2: ARTICULACIONES PRESENTADAS EN EL PLANO TRANSVERSAL 





Rangos de Movimiento en el plano transversal 


Articulación 





Tobillo Eversión 0°-30° 
Inversion 0°-35° 


Con los valores mostrados en las tablas anteriores se consideran como parametros de disefio para el robot de 18 grados de 
libertad, ademas de aseverar que los actuadores empleados en este trabajo seran servomotores, debido a su rango de trabajo 


(usualmente de 0*-180”). 
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IV. ANTROPOMETRÍA DEL SER HUMANO 


La antropometría se dedica a la determinación o estandarización de las medidas longitudinales que existen en el cuerpo de un 
individuo, con este tipo de estudios se puede establecer una escala determinada para cada segmento del cuerpo humano, teniendo 
como base la altura de este, en la Fig. 2, se aprecia cómo los valores de distancia están acotados por la altura de una persona. 
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ra ] 
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Figura.2. Antropometria del cuerpo humano [2] 


De acuerdo a la antropometria del cuerpo humano Fig. 2, se establece una altura de 43 cm, para el robot bipedo, utilizando ésta 
se obtienen las longitudes de los eslabones que constituiran al bipedo, en la Tabla 3, se muestran dichos parametros. 


TABLA 3: SEGMENTOS ESTABLECIDOS POR LA ANTROPOMETRIA 


Distancia (cm) 


Pie-Tobillo 


Pie-Tobillo | 2.65 
Tobillo-Rodilla 8.435 


Rodilla-Cadera 
Cadera-Dorso 77 
5 


Cadera-Dorso 
9.1 





V. CONSTRUCCION DEL ROBOT BIPEDO. 


A. Generación de las piezas estructurales. 


La consideración establecida para la construcción de la estructura del bípedo se basa en la anatomía del miembro inferior y 
superior del cuerpo humano. Para ello se realizó un modelo en CAD (por sus siglas en inglés Computer Aided Design). La 
morfología de los elementos estructurales fue concebida para que se adaptaran a las características de los actuadores (TowerPro® 
MG995 [3]). El robot esta constiruido por 49 piezas, las cuales brindan soporte a los 18 actuadores que a su vez inducen los 
movimientos que realiza el bipedo. 
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El robot presenta caracteristicas especiales en cuanto a la imitacion de los movimientos del cuerpo humano como son la 
flexión, extensión, de la cadera, rodilla, codo y hombro, aducción y abducción, de la cadera y hombro, la pronación y supinación 
de los tobillos, la inclinación del dorso y la rotación de la cabeza. 


En la Fig. 3 se presenta el ensamblaje final del robot. Las cadenas cinemáticas presentan un eslabón inicial o base(cadera), 
posteriormente la siguen las conexiones sucesivas de eslabones hasta llegar al efector final. Para este caso el efector final del el 
miembro superior son los brazos, en el caso del miembro inferior son los pies los cuales brindan el equilibrio necesario al robot. 





A 


Mm. 


Figura 3. Ubicacion de los grados de libertad (GDL) del robot. 


Las articulaciones que conforman al robot son las encargadas de transmitir la energia y producir movimiento, asi como las 
trayectorias a cada uno de los eslabones que conforman el robot. Para lo cual se emplean 18 articulaciones rotacionales 
(servomotor MG995) y su distribución se presenta en la Fig. 3. 


B. Simulación de análisis de esfuerzos 


Una vez generado el modelo en CAD se realiza una simulación de análisis de esfuerzos verificando así los parámetros de 
diseño establecidos, en donde se midió la deformación y el punto de ruptura de cada elemento estructural. Estos conceptos se 
generan con la asistencia del software COMSOL 5.1™, cada parte del robot se somete a una carga igual al doble del peso teórico 
del bípedo de 30N. El material utilizado fue el Acrilonitrilo Butadieno Estireno, debido a que presentó las propiedades mecánicas 
(mostradas en la Tabla 4 [7]) adecuadas para la manufactura de los eslabones 


TABLA 4: PROPIEDADES MECÁNICAS DE ABS 


Propiedades mecánicas del ABS Propiedades mecánicas del ABS 
Punto de ruptura (psi) 2500-800 Fuerza de flexión (psi) 4000-14000 
Módulo de tensión (x1013 psi) 130-420 Dureza (Rockwell) R75-115 


Elongación a la ruptura (%) 20-100 Coeficiente de expansión térmico (107% in/°F) | 60-130 
Fuerza compresiva (psi) 5200-10000 | Temperatura máxima de operación (°C) 
Módulo de flexión (x1093) [130-440 | 
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Surface: von Mises stress (Pa) 
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Figura 4. Simulación de esfuerzos en el elemento “pie”. 
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Figura 6. Simulación de esfuerzos en el elemento “brazo”. 


Un ejemplo de los esfuerzos de von Mises se observa en la Fig. 4, 5 y 6, esta información y la deformación máxima que sufren 
los elementos, en la gráfica lateral se ejemplifican los rangos mínimos y máximos para cada parámetro considerado en la 
simulación los cuales indican si los eslabones y el material cumplen con el rendimiento requerido para la dinámica del robot, los 
resultados se muestran en la Tabla 4. Cuyos datos están relacionados a las ecuaciones (1) y (2) respectivamente. 
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(rma) H ag) H a 
rr (1) 
N= — >1 0) 


Donde: G4: G3 Y @.son los mayores esfuerzos que actúan sobre el elemento al aplicar una fuerza, estos se obtienen a partir del 
tensor de esfuerzos [4]. M (o factor de seguridad), es el cociente entre el valor otorgado por los esfuerzos de von Mises [fym] y 
el valor máximo de la resistencia a la tracción del material (6%; }. 


En la Tabla 5, se identifica que el factor de seguridad de cada elemento siempre es mayor a uno lo que nos asegura 
analíticamente que el peso del robot no condicionara la estructura mecánica. 


TABLA 5: RESULTADOS DEL ANÁLISIS DE ESFUERZOS 


Esfuerzos | Desplazamiento | Factor de 
de Von total (m) seguridad 
Mises 
(Pa) 
Pie | 120506 | 1816-05 | 3.54E+01 





Los motores TowerPro® MG995 encargados del movimiento de las juntas del robot, se adoptaron en base al par ejercido 
sobre el centro de cada servomotor. Utilizando la Ecuación (3). Dónde: T es el momento de fuerza, F es la fuerza que se aplica en 
un elemento en este caso es el peso, y d es la longitud del brazo de palanca que va desde el eje del motor hasta el extremo final 
del eslabón, así se obtuvieron los pares máximos entre los eslabones los cuales se presentan en la Tabla 5. 


rt=F:d (3) 
Con la información mostrada en la Tabla 6 y tomando en cuenta el par máximo de los actuadores de 1.471 N«m [3] se 


concluye que los servomotores son los adecuados para su uso en este prototipo. 


TABLA 7: PAR MÁXIMO ENTRE ESLABONES. 


Par máximo (N -m) 
Cadera y rodilla 0.3789 


Cadera y tobillo 0.89123 
Cadera y pie 
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Cadera-Dorso 1.407 


0.336 





249 


VI. MODELO MATEMATICO DEL ROBOT 


La cinematica directa esta enfocada al estudio analitico del movimiento del robot con respecto a un eje de referencia 
cartesiano despreciando las fuerzas que originan movimiento. Por otra parte, es una función vectorial que relaciona coordenadas 
articulaciones a coordenadas cartesianas Llx,y,z]? € R*, así como la orientación [8,8,@]" e R? del extremo final de una 
cadena cinemática. 


Para realizar este prototipo es necesario conocer el espacio de trabajo con el fin de predecir el comportamiento en el espacio 
de trabajo del robot para lo cual se toma como base cada uno de los ángulos de articulares en los planos frontal sagital y 
transversal de una persona promedio [1], estos ángulos se resumen en la Tabla 1 y 2. 


Para la obtención de la cinemática del robot [5] se analizan 4 cadenas cinemáticas, 2 pertenecientes a los miembros superiores 
y 2 a los inferiores, el análisis se debe de analizar tomando como referencia la cadera (punto Or Figura 7) y analizar como una 
cadena cinemática abierta las extremidades del robot. Para obtener dicho modelo se emplea el algoritmo Denavit-Hartenberg [6]. 
En la Fig. 7 se representan las juntas del robot y su separación. 





Figura 7. Sistema de ejes coordenados del robot. 
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El método Denavit-Hartenberg consiste en determinar una tabla de paramentos B, ed, I y @ relacionados con los eslabones del 
robot. En donde @ es el ángulo de rotación sobre el eje z (Hz g), el es la distancia de translación sobre el eje z (73.4), E es la 


distancia de translación sobre el eje x (Ty) y er el ángulo de rotación sobre el eje x (Fy). 


Los parámetros Denavit-Hartenberg se representan por un producto de 4 matrices básicas: 


cos(8,)—sen(8, 10 0007/1001; o 1 
7e _ a = 00] |010 0 |/0100] | Ocos(a;)—sen (a; J0 ” 
H Ry. Lz Tal Rya 7 = = | Ed [ar Car; J on (a) 0 (4) 


i 0 0001110001 0 o oO 


Los parametros de Denavit-Hartenberg que modelan el comportamiento cinematico del robot se presentan en la Tabla 6 y 
Tabla 7. 


TABLA 7: PARAMETROS DE DENAVIT-HARTENBERG DE PIERNAS DEL ROBOT 


Pierna derecha Pierna izquierda 





TABLA 8: PARAMETROS DE DENAVIT-HARTENBERG DE BRAZOS DEL ROBOT 


Brazo derecho Brazo izquierdo 





De las Tablas 7 y 8 empleando el software Matlab™ 2015 y aplicando las matrices de trasformación homogéneas (ecuación 
4), se simula el comportamiento cinemático del robot para determinar los puntos finales de cada cadena cinemática. 


A continuación, se muestra gráficamente el conjunto de transformaciones homogéneas, en la Fig. 8, se presenta el estado inicial 
del robot. 
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Figura 8. Sistema de ejes coordenados del robot. 





Figura 9. Representación gráfica del robot aplicando variaciones en articulaciones. 


En la Fig. 9, se proponen variaciones angulares respecto al estado inicial, las cuales representan la flexión de 90° del muslo 
derecho, extensión de 90° de la pierna derecha, flexión lateral de 25° del dorso, flexión de 90° de brazos y antebrazos derecho e 
izquierdo, y abducción de 90 ° de brazo derecho e izquierdo. 


De la figura anterior se obtienen las matrices de transformación homogénea finales que representan las orientaciones y 
posiciones en el espacio cartesiano de los efectores finales (manos y plantas de los pies del robot) para este caso, las matrices 


resultantes en centímetros son: 


e Brazo derecho 


0-10 -7.5 

H.= 0 0 —1 —8.5 
t! |10 0 -13.5 

DO 0 1 

e Brazo izquierdo 

0-1 0 -7.5 

_JjoO 0-1 0 

B2=l1 0 0 —22 

00 0 1 
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e Pierna derecha 


—0.29 —0.9 —0.29 —13.68 
0.7 O —O./ -5.9 


H3=| 0.64 —0.42 0.64 —0.1779 
0 0 0 1 
e Pierna izquierda 
—0,29 0.9 0,29 12.76 
2107 0 07 —89 
A,= 


0.64 0.42 —0.64 12.15 


VII. CONCLUSIONES. 


El robot construido cuenta dieciocho grados de libertad, cabe destacar que cada motor puede ser controlado 
independientemente o bien pueden trabajar de manera conjunta en dado caso de ser requerido. Además, presenta una altura de 43 
cm y un peso de 1.5 kg, dichas características cumplen con los valores antropométricos mencionados. 


Con las matrices de transformación homogénea es posible predecir la posición y orientación de cada eslabón en un 
momento en específico esto se realiza con el fin de evitar colisiones entre eslabones. 


El método utilizado para analizar los esfuerzos involucrados en cada uno de los eslabones permito corregir de manera 
óptima la geometría de los eslabones, asegurando que la estructura del bípedo resistirá las fuerzas provocadas por el mismo, para 
un trabajo futuro se debe de considerar realizar un análisis dinámico más competo, con el fin de obtener por alguna metodología 
los centros de masa óptimos de cada eslabón, los cuales permitan brindarle un mejor balanceo y control al robot. 


En proceso de elaboración, el material por el que se optó, redujo considerablemente los costos fabricación del bípedo. De ser 
necesaria una modificación (ya sea en la forma o el tamaño) de los elementos estructurales no existe inconveniente alguno puesto 
que se cuenta con esa información. 


Considerando la información descrita aquí, para un trabajo a futuro se dará pie a un objetivo mayor que es la monitorización 
y detección de anomalías en el ciclo de marcha del ser humano, al fusionar este agente con un sistema capaz de detectar los 
ángulos de movimiento del cuerpo. 
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Sliding mode tracking control for an inertia wheel pendulum 
around its unstable open-loop equilibrium point 


Luis T. Aguilar, Andhers N. Piña, and Daniel I. Aparicio 


Abstract—In this paper we address a robust tracking control problem for an inertia wheel pendulum against uniformly bounded 
matched disturbances. The periodic motion of the pendulum will be at the up-right position which corresponds to the unstable 
equilibrium point of the unforced system. A two-relay controller based reference model was developed for generating the desired 
trajectories to be tracked by the unactuated link of the inertia wheel pendulum and the design of an sliding modes tracking 
controller. The desired amplitude and frequency were tuned by choosing the two-relay control gains properly. A sliding mode 
tracking controller was capable to track the prescribed reference trajectory. Performance issues of the synthesized controller were 
illustrated in a numerical study. 


I. INTRODUCTION 


Control theory plays an important role in the accurate desired motion of all mechanical systems in spite of external 
disturbances, imprecision value of the physical parameters, nonmodelled and parasitic dynamics. Although the tracking 
control of fully-actuated systems are well studied, the tracking control for non-minimum phase systems is a challenging 
problem since that further research applications in the motion control of underactuated systems have gone in many directions. 
Few examples where underactuated systems required to be orbitally stabilized are biped robot under the walking phase [1, 2, 
3], gymnastic robots, or electrical converters [4, 5]. 

The aim of this paper is to solve the tracking control problem for the inertia wheel pendulum under the presence of 
undesired external disturbances using sliding modes. The periodic motion of the pendulum will be at the upright position 
which corresponds to the unstable equilibrium point of the unforced system. The two-relay controller [6, 7, 8, 9] based 
reference model was used for generating the desired trajectories to be tracked by the unactuated link of the inertia wheel 
pendulum and then, design a robust tracking controller via sliding modes. The desired amplitude and frequency were set by 
choosing the two-relay control gains according to the formulas obtained from the describing function method [10]. This paper 
also addresses the finite-time stability proof of the closed-loop system. 

The paper is organized as follows. In Section II, we give the dynamic model of the plant under study and the problem 
definition is also stated. In Section III, the trajectory generation, via two-relay controller, to be tracked by the output of the 
plant is revisited. In Section IV, a sliding mode tracking control is synthesized to guarantee robust tracking of the reference 
trajectory. Numerical results illustrate the performance of the proposed sliding modes controller in Section V. Finally, 
conclusions are provided in Section VI. 


II. DYNAMIC MODEL AND PROBLEM STATEMENT 


Dynamics of an inertial wheel pendulum, taken from [11], augmented with viscous friction and disturbances is described as 


follows: 
a olal eee l= Glee a) 
y = [q,, 42)" (2) 


where q,(t) € R is the absolute angle of the pendulum, q,(t) € R is the absolute angle of the disk, v,(t) = q,(t) and 
v(t) = q,(t) are the angular velocity of the pendulum and the wheel, respectively; t € R is the time, y(t) € R? is the 
measurement output, T € R is the controlled torque applied to the wheel (see Fig. 1), f¿v, represents the viscous friction 
force affecting the actuator where f > 0 is the viscous friction coefficient, J, and J are the inertia of the pendulum and that 
of the wheel, respectively; the factor h = mgl depends on the combined mass m of the over-all wheel pendulum, on the 
gravitational constant g, and on the length lof the link, and finally, w = (w,,w,)* are the external disturbances affecting the 
system. An upper bound W; > 0, (i = 1, 2) for the magnitude of the disturbances is normally known a priori 
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suplw;(t)] <W; i=1,2. (3) 
t 





Fig. 1: Inertia wheel pendulum 


The control objective for the underactuated system (1) is to design a control input t to enforce the angular position of the 
pendulum q, to follow a desired periodic trajectory q1 (t), that is 


lim laa (©) — ax (011 =0. (4) 


The desired trajectory is designed such that q,-(t) , g,(t), and q,(t) € IR? are uniformly bounded in t. 


III. GENERATING DESIRED TRAJECTORIES CENTERED AT THE UPRIGHT EQUILIBRIUM POINT 


Let us recall, from Iriarte et al. [12], the procedure for generating the set of trajectories for the inertia wheel pendulum to 
be tracked. First, let us consider the dynamics of the wheel pendulum in terms of the reference positions and velocities 
(q,(t), q, (t)) without viscous friction 


A | bc eh ol BE 6) 


Next, we need to find the reference torque t, E R capable to produce a set of stable desired periodic motions at the non- 
actuated link (y(t) = q,,(t)) such that the periodic motion has a desired frequency Q and amplitude A,. Throughout, we 
confine our research interest in desired oscillations around the upright position of the pendulum which correspond to a 
challenging problem. 


The inertia wheel pendulum has underactuation degree one satisfying certain structural property provided in [13]. Thus, it 
is possible to make an exact linearization of (5) thus achieving local stability of zero dynamics, by taking the following 
change of variables 


Pi = qir +JI JzQər = (6) 
n = Jiġir + 2427 + Kpı (7) 


where K > 0 is constant. The last term in (6) ensures that the desired trajectories will be generated around qj, = m rad (see 
Fig. 1). From above set of equations, it is possible to verify that 


JP, =n — Kp, 
while 
Y = KJ Jzġzr hsin(qir) T Kdar, 
ij = —h cos(q1r) Gir — KJT *h sin(q1,), 
n = R (Gigs dir) + (Gig) Tos 
where 
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h cos(q1r) 
H(qır) = Em 
Rar Gar) = h(ġf + H(q1r))sin(q17) — —dyyco5(Qur) (8) 
Hence, we can take 
t, = H*(qyy) (uy — aon — ar) — azi) — R (qir Gar) (9) 


where H(q,) is nonsingular around the equilibrium point (qý, ġir) = (7,0), ao, aj, and a, are positive constants. 
Introducing the new state coordinates x = (x1, X2, X3)" = (n, ù, 7)", we obtain 

















ty 0 1 047747 TO 
ù |=] 0 o 1 fel- olu, (10) 
X3 =d —a, —az2 X3 1 
——— > —_AS —— 
A B 
Kd 
Pi F Pits J 
i ee on 
y = [100 ]x. 
A (12) 
C 


Equation (11) constitutes the zero dynamics which is orbitally asymptotically stable [14]. The following two-relay controller 
is proposed for the purpose of exciting a periodic motion in (10): 


ur = —Csign(y,) — c,sign(y,) (13) 


where c,and c, are scalars parameters designed such that the scalar-valued function output y, (t) has a periodic motion with 
the desired frequency Q and amplitude A, 
The formulas to compute c, and cz, derived from the describing function method, are [6] 


tm A s a 
mae) ifQ € Q- U Q3 


(q = TT Ap —1 (14) 
= 4 WGDI (y 1+ ¿2) elsewhere 
== E (15) 


where W (jw) = C(jwlI — A) *B is the corresponding transfer function of (10) and (12), € = —Im(W(¡M))/Re[W(¡0M)), and 
the quadrants Q, (i = 1,...,4) are defined as 


Qi = {w E R: Re{W(jw)} > 0, Im{W(jw)} > 0} 
Q, = {w € R:Re{W(jw)} < 0, Im{W(jw)} > 0} 
Q; = {w E R: Re{WGw)} < 0, Im{WGw)} < 0} 
Q, = {w E R: Re{W(jæw)} > 0,Im{W (jw)} < 0}. 


IV. CONTROL SYNTHESIS 


The control objective is to stabilize the pendulum around the desired trajectory and to keep the wheel velocity bounded. 
This last can be achieved by introducing a feedback from the rotor velocity. In this Section, we will design a sliding modes 
tracking controller which ensures (4) while providing boundedness of v, (t) and attenuating external disturbances where the 
reference signal q,(t) € R? is computed on line from (5), (9), and (13). 
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Let the pendulum tracking error and the wheel velocity error be defined respectively as 


e(t) = qrt) — q,(t), (18) 
é,(t) = ġır(t) — v,(t), (19) 
é2(t) = qor(t) — va(t). (20) 


Due to (1), (5)-(13), the errors dynamics are governed by 


21 
é1 = ğır En sing» =€1) =f. se — é>)) E, — w2) By (21) 


€2 = zr E h sin(qir — e1) +2 dos A = € w — J2W) E, (22) 
where A = (Y) — J2)J2. 
In order to achieve the control objective, let us propose the following sliding surface 
S=ée,+me, (23) 
where m is a positive constant. The following control law 
t == (Msign(s) + Ks — ysign(é,) + més) — h sin(qir — 61) + fs Gar — 62) — = Gar (2%) 
with parameters such that 
M>2WJLA*+y, K,y>90, (25) 


drives the trajectories to the sliding manifold S = {(q,q): s(e,e) = s(e,é) = 0}. Using the fact that Jiġir + Jodo, = 
—h sin(q,,), the errors dynamics (21)-(22) result in 


é, = —Msign(s) — Ks — mé, + ysign(e,) -2 (w, — w2) (26) 
. h. h Tirana . a 1 (27) 
ë, = j, nar ep ee Lan (Msign(s) + Ks + mé, — ysign(e,)) — A UW — JW). 


Throughout, solutions of above system are defined in the sense of Filippov [15] as that of a certain differential inclusion with 
a multivalued right-hand side. The discontinuous controller (24) consists of the linear gain —Ks, the discontinuous part 
—Msign(s) which ensure robustness and finite-time stability, and the rest are the nonlinear compensation terms. 


Theorem 1. The controller introduced in (23)-(24) subject to parameters (25) ensures asymptotic stability of the equilibrium 
point ° = (ef, e, e) = 0. 

Proof. We break the proof in two steps. 
1. Convergence of (e,,é,) to the origin. First, we will demonstrate the existence of sliding modes by verifying ss < 0 [16]. 
Therefore 


ss = s[é, + mé,] 


Substituting (21), (23), and (24) into above equation we have 
è J2 2 
s$<—|M—y — 27 ls] -Ks* <0 


where inequalities, due to (3), 
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2 (wy — we) < E Iw, -w IS 22W (29) 


1 1 ja 
z Jiwe2 —Jow,) € T II Jaw2 — Jaw, Ils 2 (30) 


has been used. Since ss is negative definite it is then concluded that the trajectories reach the sliding manifold S 
asymptotically. Moreover, to conclude that trajectories reach S in finite-time we take V, = s?/2, thus 


Y =ss <-|[m-y-2% |s| 
=-2[m-y-22]W 
which implies 


ee 2|M ZAP 
W alee be 


Integrating the above inequality from 0 to t we conclude that 
J —1 
t< [M-y-22| VO. 


Then it is concluded that trajectories of (26) is reached in finite-time tf. It is also concluded from (23) that, once the 
trajectories reach the sliding manifold S, then e, (t) and e, (t) tend to the origin asymptotically with a decay rate m. 

Now, we will proof that e, will tends to the origin from ¢; to infinity. To this end, note that the remaining dynamics of the 
velocity error of the wheel (27) is reduced to 


ë, = —J1J7 *ysign(éz). 
Using the Lyapunov function V,(é,) = J;*J>|é,| we have that 
Valé2) = -y 
therefore V¿(é,) will be negative definite for allt > tp. 


2. Boundedness of wheel velocity. Finally, we need to prove that e, does not escape to infinity in finite time, that is, 
Me sllėz (t)|| < oo. To this end, let us rewrite (27) as 


Ë, = —J,Jz*ysign(é2) + g(e,, é,,w) (31) 
where 
h h 1 Ji À y 
g(e, 1, W) = —7sin(q,, — e1) — —sin(q1,) — —J1W2 — J2w,) +7 (Msign(s) + Ks + més). (32) 
J2 J2 A J2 


Since (29), (30) and since e4, é,, and s decreases asymptotically to the origin (that is, |e,(t)| < |e,(0)| and | e, (t)] < 
| €,(0)|), the following upper bound for g (e1, é,,w) is obtained 


l 2h J J l 
lgte, ¿Il s+ 2 art i, (M + K|s(0)| + mé,(0)) = eo. (33) 


Let us consider now the following Lyapunov function 


V(é2) = Ji *J21é21. (34) 
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The time derivative of V(é,) along the solution of the closed-loop system (31)-(32) is 


V(é,) =—Jz7*Jzsign(é)é, 
= -Ji *J,sign(e,)(J,J7*ysign(e,) + g(e,, é,, w)) 
—y — Ji *J¿sign(e2)9(e,, é2, w) 
=Y + Ji *J2119(e,, €, w)I| 
=y + JI J280 (35) 


IA IA 


where inequality (33) has been used. Due to inequality (25), the time derivative of the Lyapunov function V(é,) is not 
negative definite. However, integrating V(é,(t)) from 0 to tf, we get 


V(ts) < Ui*J2€0 — y)ts + V(0) (36) 


which implies 


lé2(ts)1 < (£o — JJ2*Vtf + lé2(0)1. (37) 


Therefore, we conclude that e, is finite for tf < oo. The proof is completed. 


V. SIMULATION RESULTS 


In this Section, we present numerical results using the laboratory inertial wheel pendulum manufactured by Quanser Inc., 
depicted in Fig. 1 where J, = 4.572 x 107? Kg-m’, J, = 2.495 x 1075 Kg-m’, and h = 0.3544 Kg-m' s” (see [17]). The 
viscous friction coefficient f = 8.80 x 107” Nm-s was identified by applying the procedure from [18]. Simulations were 
carried out to achieve the orbital stabilization of the unactuated link (pendulum) q, around the equilibrium point q* = (7, 0). 


Setting Q = 7/2 rad/s and A, = 0.07 as desired frequency and amplitude, respectively, we have c4 = 2 and c, = —2 
which have been computed from (14) and (15). Invoking [6, Thm. 2.1], the system (10) was orbital asymptotically stable 


under K=1, a, = 1, a, = 2, anda, = 1. 





dir [rad| 


ez [rad] 


4 [rada] 





tine fe 
Fig. 1: Simulation results for the unperturbed case: (a) reference trajectory, (b) link position error, (c) wheel velocity, and (d) control 
input. 


The initial conditions of the inertia wheel pendulum, selected for the simulations, were close to q,(0) =3 rad and 
q,(0) =0 rad, whereas all the velocity initial conditions were set to v,(0) = v, = 0 rad/s. The gains of the controller (23) 


were set to M=2,m= 1, and y = 0.01. 
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Figure 2 shows the desired trajectory to follow, the tracking pendulum position error, the wheel velocity, and the input 
torque for the disturbance-free case. This Figure corroborates that sliding mode controller guarantee finite-time stabilization of 
the pendulum around the desired trajectory. In order to test the controller robustness, harmonic external disturbance w; = 
0.005 sin(t) (i = 1,2) is then applied to the closed-loop system. Good performance and desired robustness properties of the 
controller are concluded from Fig. 3. 














Fig. 2: Simulation results for the perturbed case: (a) reference trajectory, (b) link position error, (c) wheel velocity, and (d) control input. 


VI. CONCLUSIONS 


In this paper we have synthesized a sliding mode controller to solve the tracking control problem of the inertia wheel 
pendulum. The periodic motion of the pendulum will be at the upright position around the unstable equilibrium point of the 
unforced system where the two-relay controller was also used to induce of oscillations at the scalar output of the inertia wheel 
pendulum reference model and then injected as desired trajectory to the closed-loop system. Such configuration allows to 
generate oscillations without depend of the neglected dynamics. Therefore, the resulting control law ensures rejection against 
bounded matched disturbances while numerical study verifies the performance of the synthesized controller. 
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On adaptive control of a permanent magnet synchronous motor’ 


J. Moreno—Valenzuela’, Y. Quevedo-Pillado, R. Pérez-Aboytes and L. Gonzalez—Hernandez 3 


Abstract—This paper is inspired on the structure of the field oriented control by presenting a practical study of 
an adaptive nested controller for trajectory tracking control of a permanent magnet synchronous motor (PMSM) 
driving a single—link arm. It is worthwhile to notice that the new controller resembles the pure field oriented 
control except by the adaptive terms. Real-time experimental implementations have been carried out in order to 
asses the performance of the new controller with respect to the classical non adaptive field oriented control 
algorithm. 


I. INTRODUCTION 


Electric motors are the most widely prime movers used in all over the world in industrial and 
services applications (e.g., machine tools, compressors, fans, robots, etc.) and home appliances [1]. 
Specifically, special attention has been devoted to the permanent magnet synchronous motor (PMSM) due to 
its capability of a greater torque with respect to other electric motors [2]. But, the control of the PMSM is 
difficult due to its multi input nature and highly coupled by far more nonlinear dynamics, which makes it a 
topic that has attracted the attention of the control community since the eighties until now. 

The most notable technique to improve the performance of the PMSM is based on field oriented 
control first proposed in [3] and further detailed in [4]. Field oriented control allowed controllers to be 
developed by attaching a rotating reference frame to the rotor via the Park transform. Once posed in this 
reference frame, trigonometric nonlinearities are removed, resulting in a bilinear system that allows for 
independent regulation of currents. Field oriented control is the preferred scheme in industrial applications, 
due to its structure based on nested proportional-integral loops [5]. 

It is of interest to mention that there is an ample literature revealing that many theorists and 
practitioners have developed control schemes for the PMSM using different type of approaches. See, e.g., [6], 
[7], [8], [9], [10], [11], [12], for example. 

While many controllers have devised to solve position and velocity regulation, the amount of works 
exploring the trajectory tracking control of the PMSM driving a robotic load [13], [14], [15], seems to be still 
limited. 

This document presents a new adaptive motion control of PMSM driving a single—link arm. The 
complexity in this system is increased due to the nonlinearly introduced by effect of the gravity in the arm. 
The new scheme is based in the adaptation of 4 electrical parameters and 3 mechanical parameters. The 
results in this document are supported by real time experimental results. 

The organization of the paper is as follows: Section 2 presents the model of the system and the 
problem formulation. In Section 3, the new scheme is described. Realtime experimental results are described 
in Section 4. Finally, the conclusions derived from our study are given in Section 5. 


ll. SYSTEM DYNAMICS AND CONTROL PROBLEM 


A. System dynamics 


The system considered in this document is compound by a PMSM and an arm, which is also denoted 
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Position 
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Figure 1: CAD drawing of the PMSM driving a robotic load. 


as the robotic load; see Figure 1. The mathematical model of the electrical part is given by [14], [1], [11], 


d . f 
L dy = —RI L I x 
Ide q 7H, tN, al +V» 


where Z(t), V(t) and L, (with i=d,q), are current, voltage and inductance based on the (d ,q ) 
quadrature coordinates, R is a positive constant denoting the winding resistance, n, is the number of pole 
pairs of permanent magnets in the rotor, K, is a positive constant, and x(t) is the rotor angular velocity. 
The equation for the mechanical dynamics is 


d / l 
A A + LL, 


were M denotes the lumped mechanical inertia, N is the load lumped constant, B is the lumped viscous 
friction coefficient, K, is a positive constants for torque transmission, and x(t) is the rotor position. 


B. Control problem 


Let us assume that the states x(t), x(t), 1,(t) and Z (t) are available through proper sensors in 
the system. The control problem is to design control inputs V, and V, so that 


lim*(t) = 0, 


t—> 00 
where 
X(t) = x(t) —x(1) 
is the position tracking error and x,(t) represents the desired position trajectory. The desired trajectory 


x,(t) is assumed to be continuous and three times differentiable. We also assumed that the signals x,(1), 


x(t), X(t) and x (t) are bounded for all time t20. 


Adaptive control considers the use of a dynamic extension in order to estimate on—line some constant 
parameters related to the system such as the inertia, viscous friction and gravitational load. Adaptive control is 
a direct aggregation of a control methodology with some form of recursive system identification [16]. 
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Figure 2: Block diagram of the nested current/position control scheme. Adaptive parameters are considered 
in each one of the two control loops. 


II. A NEW ADAPTIVE CONTROLLER 


The nested structure of current/position control for velocity regulation was just recently proven to be 
asymptotically stable in [12]. As pointed out there, there is still theoretical and practical work to understand 
the efficiency and advantages of using a nested control structure with the current control loop as the core of 
the system. With this aim, here we propose an adaptive controller which is based in the adaptation of 7 
parameters and consists in two nested loops: 

e Adaptive current control loop, which has the goal of achieving tracking of the desired current 
commands provided by the position loop. 


e Adaptive position control loop, which deals with desired current commands in order to 
guarantee tracking of a time—varying position reference. This control loop also considers the presence of a 
robotic load. 


See Figure 2 for a general block diagram of the nested current/position controller with parameter 
adaption. The novelty relies in considering parameter adaption as well as providing a rigorous stability 
analysis, which is given in Section 4. 


A. Adaptive control of the electrical part 


The current control loop is designed with the aim of ensuring tracking of the desired current 
commands. In particular, the desired current for the phase d , denoted as /,,(t) , is assumed to be 


differentiable and the desired current for the phase g is defined null, that is, 
DOS Vee. 
In the next, phased voltages V,(t) and V,(t) are designed to guarantee that the current errors 


asymptotically converge to zero. 
In order to facilitate the analysis, it will be convenient rewrite the electrical dynamics (1) in form of 
model regressor as 
Neg! ps 
where 











W,=|1, 1, n 1% x]e0", 





and 





6,=|I, R L K,JeD*, 
It is possible to use the vector @,, in (9) with a proper definition of a regression matrix W,, to represent 


the electrical dynamics (2) so that 
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Wo. =V., 


eq ed q 
where 
W,,=|-n,t,% I, 1, 0Jen*, 
where W, and W,, are defined as regressor matrices while 0,, is a constant parameter vector. 
In order to introduce the control inputs V,(t) and V,(¢), it will be convenient to define the current 
errors 

Ma (t) = Lag O-A, 

n (6) = La (E) 1, (1) = (0, 
since 1,,(t) was defined null in equation (6). 


It is useful to define 














LO 

O, (t) E a i 
LO 
K.,(t) 


which denotes an estimation at time t of the vector of constant parameters for the phase d given by 0,, in 
(9). The vector (14) is obtained by an update law to be defined later and is used in the control inputs V, (t) 
and V (t). The proposed voltages to control the electrical dynamics in (1)-(3), which was rewritten in 
(7)-(11), are 

V, = Ws +K paa Kyss 


a E Ma > 
for the phase d , and 
e ~ Wa +K pq + Ki54; 


oy es 
for the phase q. Tt is K e to say that the controllers in (15)-(16) and (17)—(18) have a PI part in the 
current error plus an adaptive model regressor part. More specifically, 7,(t) and ņ,(t) are defined in (12) 
and (13), respectively, the signals /,,(t), which is actually the output of the position control loop to be 
defined in the next, and /,,(t), defined null in (6), represent the desired current trajectories for each one of 
the motor phases, the desired regression matrix for phase d is given by 
We =| La la Wd i|e m 














A 


6,-[i, Ri, Rofen" 














is the vector of estimated parameters of the phase d , K,, y K,, are positive proportional gains, K,, and 
K,, are positive integral gains, the desired regression matrix for phase q is defined by 
We =[=n,1,X000]€ 1. 
the vector ô , Was defined in (20), and signals ¢,, 5, are the integrals with respect to time of the current 
errors 77, , 1,, respectively. 
The purpose of using the definition of the estimated parameters ô , 1n the control inputs V, (t) and 
V (£), in (15) and (17) is to simplify the notation and simplify the derivation of stability analysis. 


Finally, it remains to introduce the adaption law to obtain the real-time update of the vector ô ¿ (6) 
used in the controller V,(¢) in (15) and V,(¢) in (17): 
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Figure 3: Block diagram of the experimental platform. Velocity x(t) is estimated via numerical 


differentiation. The block VSM means vector space modulation, which is achieved by software and then 
switching pulses are computed for the 3—phase bridge driver. 


where T, is 4x4 symmetric positive definite matrix and the desired regression matrices W¿ and we 
are defined in (19) and (21), respectively. The signals 7, and 7, are the phase current errors in (12) and 


(13), respectively. 


B. Adaptive control of the mechanical part 


Here, the controller of the mechanical part of the system (3)-(2) is presented. By considering that 
I is null, which was previously defined in (6), and replacing the definitions of the current errors in 


(12)-(13) into the mechanical dynamics (3), we obtain 
Mx + Bx + Nsin(x) =[-K,9, + Ug 94) 
= Lig + Waa May) 
where 
Wg 414) = E Ma E Laa ly Ha 
is perturbation introduced by the current errors 7, and 7,. A regression form can be used to write (23) as 
follows 
WO. = La + WOa a) 
where 














Wa=|x x simx)]en ” 
is the regression matrix of the mechanical part and 
0, =[M BN] eb? 
is the vector of constant parameters of the mechanical model assumed to be unknown. The signal w is 
defined in (24) and as previously pointed out denotes the perturbation introduced by the current errors. 


Thus, we propose the following desired current for the phase d , which indirectly controls the 
mechanical part of the system: 


Ly = Mx, + Bx, + Nsin(x,)+K,%+K,9 
=W!0.+K,%+K,9, 
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where xell is the position tracking error which was defined in (5), 
We =[%, x, sing)”, (26) 


is the regression matrix of the mechanical part of the model, 
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Figure 4: Classical non—adaptive field oriented control: Time evolution of the actual position x(t). 


ô. =[M BN] eo” (27) 





is the vector of estimated mechanical parameters, and 9 is obtained by 
3=—-K [9-X), (28) 
where K, >0. 
Let us notice that the purpose of using the filtered velocity Ht) from (28) is to avoid acceleration 


measurements x in the calculation of the signal /,,(¢), which at the same time is used in the controller 
V(t) in (15). 

The desired current command /,,(t) in (25) is designed to drive the mechanical part of system (3) 
so that asymptotic vanishing of the position error x(t) in (5) be guaranteed. As seen, /,, in (25) has the 
structure of a PD controller plus adaptive feed forward compensation of mechanical part. 

In order to update the signal 6. (t) , the adaptation law is proposed 

La) =T W” [ž+ašž], (29) 
dt 
with I, a 3x3 positive definite matrix, we as in (26), and «a is strictly positive constant whose 
selection criteria is given in Proposition 1, stated in the next Section. 


IV. EXPERIMENTAL RESULS 
A. Description of the experimental platform 


The experimental tests have been conducted in a PMSM motor prototype built at Instituto 
Politécnico Nacional-CITEDI. The hardware components used for the instrumentation and control of the 
PMSM motor experimental platform are as follows: 


64 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 7, páginas 59 - 69. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


e desktop personal computer (PC), 
e PCI data acquisition (DAQ) board Sensoray 626, 
5 
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Figure 5: Classical non—adaptive field oriented control: Time evolution of the applied voltage V, (t) and 
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Figure 6: New adaptive controller: Time evolution of the actual position x(t). 


e current sensors NT-—5 from FW Bell, 
e motor Anaheim Automation BLY 172S-24V-4000 with i 4, 


e optical encoder HB5M-1000-250-IE-D-H from US Digital, and 
e a 3-phase bridge driver based in the IR2130 circuit from International Rectifier. 


The PC runs Windows XP operative system, Matlab and Simulink, which interacts with the DAQ 
through the Real-Time Windows Target libraries. The programming of the control algorithms is based in the 
computation of the d -q voltage V, and V,, the inverse Park transformations to get the three phase 


voltages, and the vector space modulation, which computes the required switching for the transistors in the 
3—phase bridge driver. The controller is updated at 1 kHz while the the vector space modulation runs at 10 
kHz. See also Figure 3 for a block diagram implementation of the experimental platform. 
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B. Experimental results using the classical non—adaptive field oriented control (CNAFOC) 


If the adaptive part of the proposed controller is removed, the classical non—adaptive field oriented 
control (CNAFOC) is obtained [5], [11], [12], 
Va = K pala +Kaba> 
Y, > K a'la + Kino, 
where the current errors 7,(¢) and 7,(t) are defined in (12) and (13), respectively, the signals ¢,(¢) and 
č, (t) are obtained from (16) and (18), respectively, and the desired currents are 
ly =K,e+ Ke, 
i=; 
where the velocity error signal e(t) is used instead of Ht) obtained from filter (28). 


The CNAFOC has been implemented in our experimental platform. The desired trajectory used in 
this test is 
x; (t) = 3sin(6t) + 0.5 [rad]. 
The purpose of using this trajectory is to maximize the effect of the gravity in the pendular load and then to 
assess the tracking performance. 
The gains used for this experiment are 
KO F 2, Ey = 0.13, 7 = 0.75, 


K¿=0.75,K,, =0.75, K, = 0.75. 


The results are observed in Figure 4, which shows the time evolution of the desired trajectory x, (¢) 


and the actual one x(t), and in Figure 5, which depicts the applied voltage V,(¢) and V,(¢). 


C. Experimental results using the controller 


The new adaptive controller given in equations in (15)-(17), has been implemented using the control 
gains (35), filter gain K, =1000. 
Besides, the matrix 1”, used in the electrical parameter adaptation law in (22) was taken as diagonal 
matrix with the following gains 
P,, =2.4x10°,0., =I, =F,, =0.24x107, 
Matrix I’, using in the mechanical parameters adaptation law (29) was taken taken also diagonal with the 


following gains 
La = LOL, T. ; = 0.6.1, =6.0, a= 1.0. 


The results for the new adaptive controller are shown as follows: Figure 6 shows the time evolution 
of the actual position trajectory x(t) and the desired position x,(t) , Figure 7 depicts the applied phase 


voltage V,(t) and V,(t), the estimated electrical parameters L y(t), LO , R(t) and K (t) are observed 


in Figure 9, and finally the result for the estimated mechanical parameters M (t), B(t) and Ñ (t) are 
illustrated in Figure 8. 
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Figure 7: New adaptive controller: Time evolution of the applied voltage V,(t) and V,(¢). 
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Figure 8: New adaptive controller: Time evolution of the estimated electrical parameters. 


D. Observations 


We have computed the root mean square (RMS) values of the position error e(t), the current error 
vector [77,(t) 7, (t)] and the control input vector [V, (£) Ye (£)]' in the time interval 5<f<10 [s]. We have 
considered that for all time ¢=5 transients are vanished. The results are given in Table 1. 

Notice that the RMS value of the tracking error e(t) obtained for the new adaptive controller is 
improved 81% with respect to the CNAFOC. 

Besides, the RMS value of the applied voltage vector [V (OV, (t)|’ in only 7.8% bigger than the 
obtained for the classical non—adaptive field oriented control scheme. In other words, a small difference in the 
applied energy implies a significant improvement in the tracking error e(t). 

Visual examination of Figures 4 and 6 reveals that actual trajectory q(t) for implementation of the 


new controller (15)-(17) follows with more accuracy the desired trajectory x(t). 
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Figure 9: New adaptive controller: Time evolution of the estimated mechanical parameters. 
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Figure 10: Comparison of the time evolution of the tracking error e(t) for both controllers. CNAFOC 
means classical non—adaptive field oriented control. 


Table 1: Performance of the classical non—adaptive field oriented control (CNAFOC) and new adaptive 
controller. 


CNAFOC 
RMS(e) 0.3046 0.0579 


RMS(n ag) 1.440 0.824 


RMS ga 1.076 1.160 [Volt] 
maxr > S(PTPY) 





In order to have a better idea of the obtained performance, the time evolution of the tracking error 
e(t) for both controllers, is given in Figure 10. For 5<f<10 , we have computed the maximum 


peak-to-peak value (PTPV) of the tracking error e(t) for both controllers, which is shown in Table 1. The 
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maximum PTPV obtained for new adaptive controller (15) (17) is much smaller than the one obtained for the 
classical non—adaptive field oriented control (30)-G1). Specifically, the improvement is of 82.3%. 


V. CONCLUSIONS 


In this document, a new adaptive trajectory tracking controller for the PMSM driving a robotic load 
was introduced. The new scheme was inspired in the field oriented control approach, that is, in the use of 
Park’s transformation and nested current/position loops. However, the novelty was the addition of adaptive 
terms in each one of the control loops. Although the closed-loop stability analysis was not included in the 
document, we were able to show convergence of the tracking error and boundedness of the adaptation 
parameters, which was done by using Lyapunov’s theory and Barbalat’s lemma. An original experimental 
platform was built and used to validate the proposed algorithm, which was compared experimentally with 
respect to a classical controller. Better results were obtained with the new controller, showing the advantages 
of using electrical and mechanical parameter adaptation. 

Further research includes the consideration of other nonlinear effects in the system such as friction 
and saturation of the input voltage. 
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Abstract— In this paper, a Super Twisting Algorithm control (STA) implemented for a Master-Slave 
Synchronization scheme on multi-robot system is presented. To address the problem of not having full 
access to the state vector one proposes to use a High-order Sliding Mode Differentiator, a virtual 
computational tool that is used for estimating the value of the speed from the position measurement 
which normally is available. Furthermore, the proposed control scheme increase robustness under non 
modeled dynamics, avoiding overestimate the gain. Experimental results are given to illustrate the 
performance of the proposed control scheme. 


[ INTRODUCTION 


Controlled synchronization has become an important topic in recent years due to its application in 
teleoperation, manufacturing processes, systems working in coordinated schemes, assembly tasks, 
multi-robot systems, etc. The collaborative behavior provides flexibility and maneuverability that 
can hardly be obtained with a single system. An important field is the synchronization of robotic 
systems, [1-3]. 

In the formation of cooperative systems of robot manipulators, research has led to results in 
synthesis of multiple control laws. However, speaking of real applications, different problems 
related to physical constraints or cost arise. Therefore, it is important to analyze synchronization 
techniques that provide of maximum benefits and drawbacks experienced solve other control 
schemes. 

Among the main limitations that are not fully resolved by some algorithms tracking control and 
master-slave synchronization, is that of having, in practical applications, only measurement vector 
of generalized positions (linear or angular displacement) and not speed, frequently forcing estimate 
this variable indirectly. It is resulting in a further complication of the control system. Another 
problem is having the ability to reject external disturbances while it has robustness against 
parametric uncertainties. 

In the work discussed in [4], a controller that solves the problem of coordinating two (or more) 
robots, under a master-slave scheme in the case where only the position measurements are available 
is proposed. The controller consists of a feedback control law, and two observers nonlinear. 

On the other hand, a simple decentralized continuous sliding PID controller for tracking tasks that 
yields semiglobal stability of all closed-loop signals with exponential convergence of tracking 
errors is proposed for robot manipulators in [5]. A dynamic sliding mode without reaching phase is 
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enforced, and terminal attractors, as well as saturated ones, are considered. Also, some authors have 
presented an original motion control strategy for robot manipulators based on the coupling of the 
inverse dynamics method with the so-called second-order sliding mode control approach, tested on 
an industrial manipulator, [6]. Using this method, in principle, all the coupling non-linearities in the 
dynamical model of the manipulator are compensated, transforming the multi-input non-linear 
system into a linear and decoupled one. Moreover, in [7], the super-twisting second-order sliding- 
mode algorithm is modified in order to design a velocity observer for uncertain mechanical systems. 
The finite time convergence of the observer is proved. Thus, the observer can be designed 
independently of the controller. A discrete version of the observer is considered and the 
corresponding accuracy is estimated. 

This paper presents an approach of master-slave synchronization for a system of 4 DOF Robot 
Manipulators with homogeneous characteristics. Here, a variant of computed torque control is 
proposed. The main objective of the proposed controller is to overcome the parametric uncertainties 
by using Super-Twisting Algorithm (STA) [8, 9]. In fact, it has been shown in [10, 11] that this 
algorithm, which is based on the second order sliding mode technique, ensures robustness with 
respect to modeling errors and external disturbances while reducing the chattering phenomenon, 
caused by all first order sliding mode based controllers [12], (for the general problem of chattering 
see [13]). The stability and finite time convergence characteristics of the used algorithm have been 
recently proved by means of Lyapunov functions [14], so the stability analysis of the proposed 
controller has been conducted in the same way. 

In order to show the effectiveness of the controller, experimental tests were carried out on 
experimental platform with two Robot Manipulators building in the Autonomous University of 
Nuevo León (UANL). The obtained results show the performance of the proposed controller in 
terms of stabilization, tracking and robustness with respect to parametric uncertainties. 

The paper is organized as follows: In Section 2, the system description containing a mathematical 
model of Lagrangian multi-robot to define a master and slave system is presented. In Section 3 a 
Super-Twisting Control for tracking and synchronization master-salve control is derived. Moreover, 
in order to implement the controller, angular speed for the master and slave robot are estimated by 
High-order sliding mode Differentiator designed in Section 4. Experimental results given in Section 
5, illustrate the effectiveness of the proposed scheme. Finally, Conclusions of this work are drawn. 


II. DEFINITION OF LAGRANGIAN MULTI-ROBOT SYSTEM 


In [1], [11], [12], using the Lagrangian formulation for its simplicity in dealing with complex 
systems involving multiple dynamics. The equations of motion for a robot with multiple joints 
(q; € R”) can be derived by exploiting the Euler-Lagrange equations: 

Li = = qi" Mi (qi) 4: — Vi; = fora > oe = Ti, (1) 
where (1 <i <p) denotes the index of robots or dynamic systems comprising a network, and p is the 
total number of the individual elements. Equation (1) can be represented as 

M; (q): + C¿(q; q:3q; + g:(q:) = T; (2) 
where M;(q;) is symmetric, positive definite and differentiable in q;, g;(q;) = a E€ R” and 1; is 


a generalized force or torque acting on the i-th robot (for this particular case, i = m, s). 
C;(q;, 4;) 4; € R” represents the Coriolis and centrifugal forces. 

If the matrix C;(q;, ,)q, € R” is defined using the Christoffel symbols, then the matrix M,(q;) — 
2C;(q;,q;) is skew-symmetric i.e. 


cd (M:a) — 2C; (q; ai)) x=0; VxeR", (3) 

The matrices M;(q;) and C;(q;,q,) are bounded with respect to q;, as 
0 < Mim < 1IM¡(q)1 < Mim; VxeR", (4) 
Cias Dll < Cimllxll;  vVxeR”, (5) 
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For this case, we define the master system as 


Mm(4m)4m + Cn (Gms Am)4m + Em(Am) = Tm» (6) 
and the slave system 1s 
Ms(qs)4s + Cs(Qs 4s)4s + 8s(s) = Ts. (7) 
The physical parameters of the links in the robotic manipulators are described in Table I, these 
were estimated using the software Solidworks®. While the inertia matrices of inertia are known, it 
is important to mention that we do not know the coriolis matrices exactly, therefore we have 
parametric uncertainty. 


Il. SYNCHRONIZATION BASED ON STA 


In master-slave synchronization, there are two important control tasks. The first 1s to propose a 
tracking control strategy that allows the master system to follow a desired trajectory. In addition, 
the second is to propose synchronization control strategy that allows the slave system to achieve a 
master trajectory. 

Therefore, for unidirectional schemes as in this case, it made the following assumptions: 
Assumption 1. There is not any feedback from the slave to the master. Control can be performed 
only in one direction. 

Assumption 2. The master-slave synchronization occurs no matter how initialized them. It must be 
that their states asymptotically coincide, which call it synchronization criterion, i.e. 














; Gm qs 0 
lim+_o a — la ) = 8 
ela) (4. )I| = Go) (8) 
After considerate the above assumptions, it proceeds to write the equation (6) as follows 
dm = Min (Am) [tm 7 Con (Gm, Am) 4m = Em(am)], (9) 


where qm € R” is a vector representing the positions or generalized coordinates and Åm 
represents the velocity vector. It is important to note that vector (Am 4m)! represents the states of 
the master system. A tracking control law that eliminates nonlinearities of the equation (9), using 
state feedback, is given by 

Tm = Mm(Am)Vm + Cm (Aam Am) Gm + Em(Am), (10) 
where Vm is a new “auxiliary input”. In the equation (10) the terms Cm (qam Am) Am + 8m (Arm )> 
are added in order to cancel from equation (9). Therefore, the system obtained is 


Min(Gm)Gm = Mm(Gm)Vm- (11) 
Because M,,,(q,7,) is invertible, from (11) a linear closed loop system is defined as 
Gm = Vm (12) 


which is in the Brunovsky canonical form [13]. 
The auxiliary input Vm is designed by a robust control strategy based on second order sliding modes 
known as Super Twisting Algorithm (STA) [9] and [11]. As mentioned in [18] and [19], its goal is 
to enforce the sliding mode on the manifold 

Om = Amı Am + Am24m» (13) 
where ùm = qm- qa and ùm = Um — ġa, Ga and Gq are the desired position and desired 
velocity respectively, Amı and A, are positive diagonal matrices. The implementation of the 
control scheme (10) requires knowledge of the master robot dynamic model, which is important to 
mention that one of the benefits of STA is its tolerance for parametric uncertainties. q,, 1s other 
necessary element, which will be estimated by a robust differentiator (see Section 4) that gotten 
Am. because 1t doesn't have the complete information of the state vector. Therefore, equation (10) 
1s written as 


Tm = Mm(4m)Vm + Cm (Am: Am )@m + Em (Am), (14) 
Considering the previous, Vm 1s defined as 
i 
Vm = -K m1|0m| /2sign(Om) + Hm, (15) 


Him = —Km2sign(Om), 
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where K,,, and K,, are positive diagonal matrices and Om 1s the sliding surface for tracking 


control which it is defined in (13). The STA control (15) is continuous since both -Kilon 2 
and the term My = —K m2 f sign(o,,) are continuous. Now, the high frequency switching term 
sign(d,,) is “hidden” under the integral [9]. 
In addition to equation (8) is met, a strategy for master-slave synchronization is designed below. 
Now equation (6) is written as follow 

ds M,(q;) [ts -_ C; (qs, 4s)4s — gs(qs)], (16) 
where qs € R” is a vector representing the positions or generalized coordinates from slave robot 
and q, represents the velocity vector. It is important to note that vector (qs 45)? represents the 
states of the slave system. Accordingly a control law that synchronizes the slave system to the 
master, i.e. the slave can achieve the master trajectories qm and Q,n, is given by 

Ts = M,(q;)Vs T C; (qs, q;)qs T gs (qs), (17) 

where v, is a new “auxiliary input”. In the equation (17) the terms C, (qs åds)ds + g8;(q;), are 
added in order to cancel from equation (16). Therefore, the system obtained is 


M; (qs)äs = Ms(qs)vs. (18) 
Because M,(q,) is invertible, from (18) a linear closed loop system is defined as 
ds = Vs. (19) 


It is not easy to see that the master-slave synchronization is given, however this is achieved by 
means of the following synchronization sliding surface 

O= Asids + 4524, (20) 
where Gq; = Qs — Am and ù; = As — Am, Am and Fm are the master estimated position and 
master estimated velocity respectively, Asų and A,» are positive diagonal matrices defined. The 
implementation of the control scheme (17) with the synchronization surface (20), requires 
knowledge of the slave robot dynamic model, q,,,, Am and As are other necessary elements, which 
will be estimated by a robust differentiator (see Section 4). Then, equation (17) is written as 


Ts = Mg(qs)v; + Cs(qs,Gs)ds + gs(qs), (21) 
Considering the previous, v, is defined as 
— Woo; 
¿ds —Ks,105| 2sign(0;s) + Hs, (22) 


Üs = —Ky2sign(0,), 
where K., and K;,, are positive diagonal matrices and oa, is the sliding surface for 
synchronization which it is defined in (20). The proof of finite time convergence to zero of the 
variables vn and v, is explicitly given in an Appendix. It is conducted in the same way that of [14]. 
Therefore, it can be concluded that the synchronization criterion (8) is fulfilled. 


IV. HIGH-ORDER SLIDING MODE DIFFERENTIATOR 


A. Levant proposed in [20] and [21], a robust high-order differentiator based on sliding mode as 
follows. 
Suppose that it is known that the input signal is compounded of a smooth signal fọ(t) to be 


differentiated and a noise being a bounded Lebesgue measurable function time. Both signals are 
unknown and only their sum is available. It is proved that if the base signal fo(t) has r-th derivate 
with Lipchitz’s constant L>0, the best possible k-th order differentiation accuracy is 


k r—k+1) 
dyL l(r+1) ¢ / (r+1), where dg > 1 may be estimated (this asymptotic representation may be 
improved with additional restrictions on fọ(t). Moreover, it is proved that such a robust exact 
differentiator really exists. 
Let the aim be to find real-time robust estimations of fy(t), f(t), ..., 7 (t), being exact in the 
absence of measurement noise and continuously depending on the noise magnitude. The 
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differentiator is recursively constructed. Let a (r — 1)th — order differentiator D,_,(f(t), L), 
produce outputs Di_, (i=0,1,...,r — 1), which are estimates of f(t), fo(t), ..., ASES for any 
input signal f with pa having Lipschitz constant L > 0. Then, the 7-th order differentiator has 


the outputs z; = DÉ, i = 0.1,..r, defined as follows 


r-1 
lo =m y =-eLPlzo — f|" sign(zo = fŒ) + z, (23) 
E =S Ds-1(M, L), "Z1 = DO L). 
Here D,._4(f(t), L) is a simple nonlinear filter 
Do: z= —eLsign(zo = f(t)); 0 La (24) 
In other words the r-th order differentiator has the form 
r—1 
Žo = no No = gol "iz 5 FOIT sign(zo — f(t)) + Zi, 


1 e 
“= Ny M =-01L/r-1|z, — nolr=isign(z, — No) + 22, 05) 
l 1/ 0 
Zr-2 = r-z Nr-2 = —Or—2b '2|Zr-2 — Nr-3l2Sign(zZr-2 — Nr-3) + Zr-1> 
Zo = —0,_,Lsign(Z,-1 — 8,2). 
Taking into account the above, we can define the structure of the robust differentiator to estimate 
Am» Am and qs i 
djio = Njio 
2 
Ea ee A A 
Njio = —Ool aldo — qul sign(ĝjro — 9 ji) + Gir 
4ji1 = Ni (26) 


1 
Mji1 = ~0,L Ona ES njio|2sign(Gji1 — N jio) + 4 51,2, 
Gji2 = —0,Lsign(Gji2—nya), j= ms, and i=1,2,3, 
where qji for j =m,s and i = 1,2,3; is the output measurable, The position estimation error is 
djio = dio =a and 7 ;;,9 is the estimation speed for each joint. 
Proposition 1. Consider the system (6) and (7) in closed-loop with the controller (14) (21), using 


the estimates obtained by the differentiator (26). Then, the trajectories of the slave system (7) 
converge in finite-time to the trajectories of the master system (6). 


V. EXPERIMENT 
A. HARDWARE AND SOFTWARE 


In order to validate the proposed controller, experimental tests were carried out in an 
experimental platform which consist in two homogeneous Robot Manipulators building in the 
UANL, each robot has four degree of freedom of rotational configuration, three of them describe 
the principal movements of the robot and define his workspace, the last one DOF describe the 
orientation of the gripper, the end effector always stay parallel in the XY plane. The actuators are 
servomotors modified which only consist in a motor of DC coupled to a gear train, and a 
potentiometer to measure the articular position of the links of the robot (see “Figure 1”). 

For the acquisition and transmission of information an Arduino® Due was used, that consist in a 
microcontroller board based on the Atmel® SAM3X8E ARM Cortex-M3 CPU. It has 54 digital 
input/output pins (of which 12 can be used as PWM outputs), 12 analog inputs, 4 UARTs (hardware 
serial ports), an 84 MHz clock, an USB OTG capable connection, 2 DAC (digital to analog), 2 
TWI, a power jack, an SPI header, a JTAG header, a reset button and an erase button. 
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The control law given by Eq. (14) and synchronization law given by Eq. (21) were developed on 
a PC Intel Core 13. Control scheme were developed in MATLAB/Simulink® environment, because 
there are special blocks for transmission and acquisition signal for Arduino® board. Using Runge- 
Kutta solver with an integration step of 0.005 s., was implemented this control. In Figure 2 it can 
observed as communicating with sensors and actuators is achieved through card Arduino® Due and 
MATLAB/Simulink®. The physical parameters of the Robots are given in Table I with reference to 
Figure 3. 

It is important to mention that the algorithm and the plant were programed in continuous time, 
only the acquisition and sending of the information was made in a discrete way, so that an analysis 
of the discretization not was considered, but nevertheless, would be an important point for a future 
work. 





Figure 1. Experimental Platform. Consists of two Robot Manipulators, an Arduino Due board and a PC 
with MATLAB/Simulink®. 
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Figure 2. Diagram, which showing, how the transmission and acquisition data system between hardware 
and software is done. 
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TABLE I. Parameters of the Robots 


Length 5 0.16 m 





Figure 3. Profile view of the four DOF Robot Manipulator. 


B. EXPERIMENTAL CONDITIONS 


In order that the robot has soft movements according to the constraints of the actuators, a 
polynomial functions class C” was proposed to generate the desired trajectories for each joint. The 
function 1s 

qai = azt? + azt? + aıt +aọ; i= 1,2,3, (27) 


3 2 , a - 
where ao = qoi, 44 = 0, a, = (=) (afi — qoi), Az = — (5) (qfi — qoi); qoi 18 the initial position 


and (fi is the final position. 


For this application, the chosen gains for STA are given as 


5 0 0 0.02 0 0 
Ami =\|0 42 0l Amo ={ O 0.0327 0 |, (28) 
0 0 5 0 0 0.0045 
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8 0 0 0.02 0 0 
Ag =|0 42 0 |, Ao) = 0 0.003 0 , (29) 
1 


0 0 42 0 0 0.00 
4 0 0 0.35 0 0 

Kmi=|0 45 0 |, Kmz2=|(| 0 0.30 0 |, (30) 
0 0 3.5 0 0 0.15 
3 0 0 0.12 0 0 

Ka =(0 34 OJ], Ks={ 0 030 0 | (31) 
0 0 4 0 0 0.027 


High-order sliding mode differentiator gains are displayed on Table II. 


TABLE II. High-order sliding mode differentiator gains for Master and Slave Robots 
Joint | & | ùo | @ | L | 


The tracking control strategy (14) is proposed for the master robot in order that this reaches the 
desired trajectories and synchronization control strategy (21) is implemented for the slave robot that 
tries to follow master trajectories. The desired trajectories are three different continuous signals 
constructed from a third order polynomial designed considering the workspace of the robots. 


C. EXPERIMENTAL RESULTS 


For a better understanding of the plots, the Figures 4-11 are shown in three windows. Each 
window shows the performance of each of the joints in the time interval [0,7) sec., during the 
master-slave synchronization experiment. 

From responses in Figure 4, it can be seen that master-slave synchronization scheme is 
fulfilled. In addition, here we can see that the estimated trajectories for the master robot not fully 
reach the desired trajectories so a tracking error of the joint 1 to 2 and the joint 2 to 3 is induced. 
This effect is also reflected in the slave robot as shown in Figure 5. It should be recalled that the 
main objective in synchronization systems is that slaves reach the trajectories of the master, but is 
not necessarily that the master reaches the desired trajectories. Notice that the goal 1s to follow the 
trajectories of the master robot q,,,, and not the desired master robot trajectories qq which may not 
be achieved by the master because of noise, parametric uncertainty or unmodeled dynamics of the 
master robot, like unmodeled friction phenomena, unknown loads, etc., [27]. 

In Figure 5, synchronization errors for each of the generalized coordinates are presented. The 
window 3 shows that the synchronization error is larger in the third joint of the slave, this is induced 
the link 2 to 3. 

Figure 6 depicts the estimated angular positions of the master robot. This shows how the existing 
noise in the measured signals is reduced considerably with the estimated signals. 

The estimation error for each master joint coordinates 1s in Figure 7. The window 3 shows that the 
estimation error is larger in the third joint of the slave, this 1s induced the link 2 to 3. 

Estimated angular velocities of master and slave are shown in Figures 8 and 9, respectively. The 
experimental results present errors bound in the transitory state (see Figure 4), this effect is 
observed mainly in the estimated velocity (see Figure 8 and 9), possibly due to noise amplification 
and unmolded dynamics. 

Finally, the control inputs for the master and slave are shown in Figures 10 and 11 respectively. 


71 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 8, páginas 70 - 88. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


Angular Position (Deg) 


Angular Position (Deg) 





Time (sec) 


Angular Position (Dea) 


g 8 5 





Time (sec) 


Figure 4. Master-slave Synchronization for each joint coordinates. Desired trajectories for each joint are 
bounded periodic signals these are in blue; the estimated trajectories for the master robot are in green and the 
measures trajectories of the slave robot are in red. 
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Figure 5. Synchronization errors. The average error in the time interval [0,7) sec. for G,, is 0.0622, of Gs» 
is 0.279 and to G53 is 2.352. 
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Figure 6. Angular positions qm and estimated angular positions (,, of the Master Robot. Measures master 
robot positions are green and estimated positions are red. 
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Figure 7. Estimation errors for each master joint coordinates. The average error in the time interval [0,7) sec. 
for m1 18 0.0054, of mz is 0.085 and to Q,m3 is 0.0059. 
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Figure 8. Estimated angular velocities of Master Robot. 
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Figure 9. Estimated angular velocities of Slave Robot. 
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Figure 10. Control inputs for the Master Robot. 
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Figure 11. Control inputs for the Slave Robot. 
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VI CONCLUSION 


In this paper, a super twisting controller algorithm has been proposed and successfully 
implemented on a Master-Slave Robot System. The controller has been designed using second order 
sliding mode approach in order to avoid chattering phenomenon and to ensure robustness with 
respect to model uncertainties. With the aim of implementing the proposed controller, a High-order 
sliding mode differentiator was designed for estimating non-measurable states. The experimental 
results obtained on a Master-Slave Robot System clearly show the effectiveness of the proposed 
controller in the Synchronization case. 

Although, several authors have implemented in nonlinear dynamical systems and robotic 
manipulators, controllers based on second order sliding mode as the STA efficiently, the greatest 
contribution of this work is the modification of a classic control such as the computed-torque 
control which is generally designed with a PD control in closed loop. Its controller was replaced by 
the STA on a Master-Slave Robot scheme. 

Finally, because the STA controller is implemented with the high order differentiator for 
estimating the angular velocities, tuning is facilitated. Contrary to the implementation of some 
classic controllers as presented in [26], since high order sliding mode differentiator (observer) 
converges in finite-time, control law and observer can be designed separately, i.e., separation 
principle is satisfied. 


APPENDIX 
A. LYAPUNOV STABILITY ANALYSIS OF THE STA 


Consider the standard Super-Twisting Algorithm (STA) without perturbation term 
2 =K, 12 | /2sign(z4) + zz, 62) 
Zz = —Kosigntz1), 
where z;, i = 1,2, are the scalar state variables, —K; are positive gains to be designed. The solutions 
are all trajectories in the sense of Filippov [21]. The proof is stated as in [23] and [24]. Consider the 
Lyapunov function presented in [24] 


V(z) = ç" Pç, (33) 
1 
not in the state z but in the vector q? = iz, l2zsign(Z,), zzl, with a particular symmetric an positive 


definite P matrix. The function in [20] is continuous and differentiable except on the set 
{(Zz1 Z2): Z4 = 0}. Moreover, the solutions of the system (32) before arriving to the equilibrium 
point Z4 = Z = O every time crossing the line z4 = 0 when z, % 0. This means that the derivative 
of the function [20] exist almost every time till the moment when z, = z, = 0. It was shown in [20] 
that function is a strong Lyapunov function for (32), i.e., its derivative V, when it exists, is negative 
definite when K4, Kz > 0. 
It is very surprising that the construction of the suitable matrices P = PT > 0 that provide a 
Lyapunov function can be reduced to the solution of an algebraic Lyapunov equation 

ATP + PA = -Q, (34) 
with a special selection for the A matrix. This nice and unexpected fact allows us to reduce the 
construction of Lyapunov functions for the highly nonlinear STA (32) to the usual linear procedure 
of solving the equation (34) 
Proposition 2: Consider the matrix 


1 
A= 2 35 
ER zl N ) 
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where Kı > 0,K, > 0, so that A is Hurwitz. For every symmetric and positive definite matrix 
Q = Q" >0, the function (33) is global, strong Lyapunov function for the STA (31), where 
P = P" > 0 is the unique symmetric and positive definite solution of (34). Moreover, the derivative 
V of Lyapunov function satisfies the differential inequality almost every where 


. = 
V < -y(Q)V2(x), (36) 
where 
1 
a Amm OA nE 
Aer (37) 


is a Scalar depending on the selection of the Q matrix. 

Proof: A is Hurwitz, since its characteristic polynomial is p(s) = s? + ~Kys + ~ Ky, The fact that 
under the given conditions the solution P of (34) satisfies the stated properties is standard in control 
[25]. Therefore, V(z) in (33) is continuous, positive definite and radially unbounded in R?. 
Furthermore, it is differentiable everywhere, except on the line {z, = 0). Since the trajectories of 
(32) cannot stay on this set, before reaching the origin, V can be calculated in the usual way. Since 
(= E (Aka la lžsign(z1) + z2) — Kastan) = 4, (38) 


2 
|x112 





it follows that 

Y = ~ST(ATP + PAN = Sra 
Now, from the standard inequality for quadratic forms 

Amin {PIZIE < GPS < Amax LP HIS IN, (40) 


where ||@||3 = ¢7 + (4 = |z,| + z2 is the Euclidean norm of Y, and the inequality 


06. (39) 


1 

1 V2 
3,1 = 12,12 < [IZ ll, < — (41) 
Ain CP) 


it follows easily that (36) is satisfied, so that V(z) is a strong Lyapunov function. 


ACKNOWLEDGMENT 


The authors are grateful with the editor and the reviewers for their valuable comments and 
suggestions that allowed improvement significant of this work. 


This research was supported by Secretaria de Investigacion y Posgrado del Instituto Politécnico 
Nacional (SIP-IPN). Also, this work was partially supported by the Mexican CONACYT (Ciencia 
Basica) under Grant No. 105799, PAICYT UANL and Project PCP-CONACYT. Additionally, 
Jesus Martinez acknowledges the support received by CCA IPN and CONACYT for conducting his 
research stay at the UANL. 





REFERENCES 

[1] S. Chung, and J. Slotine, “Cooperative Robot Control and Concurrent Synchronization of Lagrangian 
Systems”, IEEE Transactions on Robotics, vol. 25 (3), pp. 686-700, 2008. 

[2] S. Chung, “Nonlinear Control and Synchronization of Multiple Lagrangian Systems with Applications to 
Tethered Formation Flight Spacecraft”, Ph.D. Thesis. Massachusetts Institute of Technology (MIT), 
2007. 

[3] H. Nijmeijer, and A. Rodriguez, Synchronization of Mechanical Systems. Series Editor: Leon O. Chua. 
World Scientific Publishing Co. Pte. 2003. 

[4] A. Rodríguez, and H. Nijmeijer, “Coordination of two robot manipulators based on position 
measurements only”, Dynamics and Control Reporter, vol. 23, 2000. 

[5] V. Parra, S. Arimoto, Y. Liu, G.Hirzinger, and P. Akella, “Dynamic Sliding PID Control for Tracking of 
Robot Manipulators: Theory and Experiments”, IEEE Transactions on Robotics and Automation, vol. 19, 
no. 6, pp. 967-976, December 2003. 


87 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 8, páginas 70 - 88. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


[6] L. M. Capisani, A. Ferrara and L. Magnani, “Design and experimental validation of a second-order 
sliding-mode motion controller for robot manipulators”, International Journal of Control, vol. 82/2, pp. 
365-377, 2009. 

[7] J. Davila, L. Fridman, and A. Levant, “Second-Order Sliding-Mode Observer for Mechanical Systems”, 
IEEE Transactions on Automatic Control, vol. 50, no.11, pp. 187-193, November 2005. 

[8] A. Levant, “Higher-order sliding modes, differentiation and output-feedback control”, International 
Journal of Control, vol. 76, No. 9/10, pp. 924-941, 2003. 

[9] Y. Shtessel, et al., Sliding Mode Control and Observation. Birkhauser, Springer Science+ Business 
Media New York, 2014. 

[10] G. Bartolini, L. Fridman, et al., Modern Sliding Mode Control Theory. Springer-Verlag Berlin 
Heidelberg, 2008. 

[11] W. Perruquetti, and J. Barbot, Sliding Mode Control in Engineering. Marcel Dekker, Inc., New York 
Basel, 2002. 

[12] A. Pisano, E. Punta and E. Usai “A survey of applications of second-order sliding mode control to 
mechanical systems”, International Journal of Control, vol. 76 No.9-10, pp. 875-892, 2003. 

[13] V. Utkin, et al., Sliding Mode Control in Electro-Mechanical Systems. By Taylor Francis Group, Second 
Edition, United States of America, 2009. 

[14] A. Davila, J. A. Moreno, and L. Fridman, “Optimal Lyapunov function selection for reaching time 
estimation of Super Twisting Algorithm”, joint in 48th IEEE Conference on Decision and Control and 
28th Chinese Control Conference Shanghai, P.R. China, December 16-18, 2009. 

[15] C. Ma, et al., “Synchronization of networked Euler-Lagrange systems by sampled-data communication 
with time varying transmission delays under directed topology”, Neurocomputing, 2014. 

[16] A. Abdelkader, et al., “Synchronization of Lagrangian Systems with Irregular Communication Delays”, 
IEEE Transactions on Automatic Control, vol. 59, No.1, pp. 187-193, January 2014. 

[17] H. Sira-Ramirez, et al., Control de Sistemas no Lineales. CEA y Prentice-Hall, 2005. 

[18] L. Derafaa, A. Benallegueb, A. and L. Fridman, “Super twisting control algorithm for the attitude 
tracking of a four rotors UAV”, Journal of the Franklin Institute, Published by Elsevier Ltd., Vol. 349, 
pp 685-699, 2012. 

[19] J. Rivera, et al., “Super-Twisting Sliding Mode in Motion Control Systems”, Sliding Mode Control, Prof. 
Andrzej Bartoszewicz (Ed.), ISBN: 978- 953-307-162-6, InTech, 2011. 

[20] A. Levant, “Higher-order sliding modes, differentiation and output-feedback control”, International 
Journal of Control, vol. 76, No. 9/10, pp 924-941, 2003. 

[21] C. Edwards, et al., Advances in Variable Structure and Sliding Mode Control. LNCIS 334, pp 143-168, 
Springer-Verlag Berlin Heidelberg, 2005. 

[22] A. F. Filippov, Differential equations with discontinuous righthand side. Kluwer. Dordrecht, The 
Netherlands. 304 p. 1988. 

[23] A. Levant, and A. Michael, “Adjustment of high-order sliding-mode controllers”, International Journal 
of Robust and Nonlinear Control, vol.19 no.15, pp.1657-1672. 2009. 

[24] J. A. Moreno, and M. Osorio, “A Lyapunov approach to second-order sliding mode controllers and 
observers”, in 47th IEEE Conference on Decision and Control, CDC 2008, pp.2856-2861, 2008. 

[25] H. K. Khalil, Nonlinear Systems. Third ed. Prentice-Hall. Upsaddle River, New Jersey. 750 p. 2002. 

[26] J. Martinez, S. Rodriguez, J. de León, and P. Niño, “Sincronización maestro-esclavo en Sistemas 
Dinámicos Lineales y no Lineales” AMDM 2016 Tercer Congreso Internacional Sobre Tecnologías 
Avanzadas de Mecatrónica, Diseño y Manufactura, Colombia, 2016. 

[27] H. Nijmeijer, A. Rodriguez, Synchronization of Mechanical Systems. World Scientific Series on 
Nonlinear Science Co. Pte. Ltd., Leon O. Chua Editor, University of California Berkeley, 2003. 


88 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 9, páginas 89 - 97. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


Integración de una plataforma y una grúa como prototipo para 
rehabilitación de niños con PCI 


Rodríguez-Méndez Jessica E., Ramos-Saavedra Kassandra G., Ambriz-Sandoval Karen A., 


Hernandez-Oliva Noemi, Alejandre-Flores Marisol. 
Instituto Politécnico Nacional, CECyT 2 Miguel Bernard, Av. Nueva Casa de la Moneda No.133, Colonia Lomas de Sotelo, Delegación 
Miguel Hidalgo, C.P. 11200, Tel. (55)5729 6000, ext. 67059, Ciudad de México. 
(affh.wii@gmail.com,tony_megadeth@hotmail.com,kaas1998@hotmail.com,nhernandezo@ipn.mx, marisolalejandre_flores@hotmail.com) 


Resumen— El presente trabajo tiene como principal objetivo la integración de una plataforma y una grúa ortopédica 
que sirvan de asistencia en la rehabilitación de marcha para pacientes con parálisis cerebral infantil (PCI). Esta propuesta 
está formada por medio del diseño de un prototipo de entrenamiento de marcha, el cual tiene como función principal 
asistir a los terapeutas en la rehabilitación de niños con este tipo de discapacidad, la cual se enfoca únicamente en 
problemas para caminar adecuadamente, es decir en pacientes que no tienen comprometidas más funciones motoras de su 
cuerpo o estas son mínimas. Este tipo de terapias aplicadas de forma temprana ayudan considerablemente en el proceso 
de aprendizaje de marcha (caminar) del niño, con lo cual se espera que el niño pueda desplazarse de un lugar a otro por sí 
mismo. La integración que se propone para el desarrollo del presente prototipo, está conformado por una estructura 
mecánica que consta de barandales de seguridad y una plataforma de marcha en una caminadora, así como de la 
adecuación de una grúa ortopédica con arnés para la sujeción de los niños, estas se implementan con la finalidad de 
levantar y movilizar a los pacientes que no puedan sostenerse totalmente por sí mismos, la cual es ajustada mediante el 
arnés y este va de acuerdo a la estatura del paciente. El control de la plataforma de marcha es realizada por medio de una 
tarjeta de control MC-60, con sus diferentes elementos eléctricos y electrónicos que la componen, como son botones 
pulsadores, un potenciómetro lineal, entre otros; los cuales permiten la variación de la velocidad de la caminadora y así 
poder someter al paciente a diferentes niveles de intensidad en la marcha. Estos grados de progresión son determinados 
mediante el avance de la terapia y la valoración del fisioterapeuta encargado. Una vez ensamblados todos los dispositivos y 
como parte de la integración final, se realizaron algunas adecuaciones con el fin de garantizar la seguridad del paciente en 
su rehabilitación así como otras propuesta a considerar a futuro, a la par con pruebas de validación del mismo para las 
operaciones de arranque y paro. 


I. INTRODUCION 


Actualmente un problema de salud que se ha ido incrementando es el de casos con niños con alguna 
discapacidad, como lo es la parálisis cerebral (PCI), los cuales necesitan terapias físicas que les ayuden a caminar, 
moverse o alguna otra capacidad motriz. En ese aspecto en México, el Centro de Cirugía Especial a través de la 
Oficina de Representación para la Promoción e Integración Social para personas con Discapacidad de la Presidencia 
de la Republica, reporta como estadísticas que cada año aumentan alrededor de 270 mil personas con discapacidad 
en el país, de los cuales 12000 corresponden con niños con algún tipo de parálisis cerebral; sin embargo estas cifras 
únicamente son estimaciones ya que como tal no existe en el país un registro exacto de pacientes, médicos y centros 
especializados los cuales estén enfocados específicamente a llevar un control total de la población involucrada. Por 
otro lado, para la Organización Mundial de la Salud (OMS), calcula que el 14% de la población mexicana sufre de 
alguna discapacidad, estos datos han sido revisados en [1]. Con lo cual puede notarse que este problema no es 
exclusivo del país, es una afectación a nivel mundial, teniendo diversos factores que lo generan, sin embargo el 
objetivo de este trabajo no es centrarse en el diagnostico o causas que lo originan, la parte esencial radica en el hecho 
de conocer a grandes rasgos que es y algunos de los tipos de rehabilitación, por lo cual si se está interesado en 
conocer a detalle la enfermedad se recomienda revisar y consultar los tipos de PCI y sus afectaciones con mayor 
detalle en [2], [3] y [4], así como en la guía del Sector Salud para el diagnostico del niño con parálisis cerebral [5]. 


Retomando el interés en el tema, nos enfocaremos en los avances que se han obtenido en años recientes en el 
proceso de rehabilitación, es en este sentido que áreas como la mecatrónica ha permitido incrementar el desarrollo, 
mediante propuestas de integración y diseño de algunos prototipos que permitan a los pacientes con este tipo de 
discapacidad mejorar su calidad de vida, mediante el fortalecimiento de sus extremidades inferiores, de sus 
capacidades de relacionarse con el entorno, entre otras; todas con aportaciones específicas y con validaciones 
experimentales como con pacientes, obteniendo una mejora y una respuesta positiva en su uso, sin embargo aún hay 
mucho más por diseñar. Posteriormente se realizara un análisis detallado de algunos prototipos que se encontraron en 
la literatura y los cuales representan una valiosa aportación al prototipo que se desarrollara en el presente artículo, 
debido a que incluyen diferentes tipos de estructuras en su diseño, sin embargo, hasta hace poco tiempo no todos 
estos se enfocaban en niños o se requiere de dispositivos externos para lograr un proceso de rehabilitación, lo que 
dificulta el proceso mismo. En ese sentido la Red de Expertos en Robótica y Mecatrónica del Instituto Politécnico 
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Nacional (RERYM IPN) se ha propuesto desarrollar el diseño de un prototipo que considere las características y 
necesidades de pacientes menores a fin de brindar un desarrollo propio con el cual se genere una opción más para 
dispositivos robóticos para rehabilitación en niños con PCI, en ese sentido el trabajo está dividido a través de grupos 
de trabajo denominados nodos, en el correspondiente con el CECyT 2 Miguel Bernard, esta aportación está enfocada 
al trabajo que se desarrolla con alumnos de nivel medio superior por medio de la integración de un prototipo de tipo 
experimental, el cual contempla de forma general como se activaría o manipularía el prototipo, es decir operaciones 
básicas de control como lo es el arranque y paro del mismo. 


El presente artículo está organizado de la siguiente forma en la sección II se describe la integración de la estructura 
plataforma-grúa, incluyendo las consideraciones y el análisis de diferentes prototipos que existen hoy en día; en la 
sección III se presentan los elementos eléctricos y electrónicos asi como la descripción de la selección de los 
dispositivos empleados. En la sección IV, se presenta la integración de los componentes y el ensamble final del 
prototipo. Las pruebas realizadas para validar el funcionamiento del prototipo se presentan en la sección V. 
Finalmente en la sección VI se presentan las conclusiones del artículo y posibles opciones de mejora en el diseño del 
control del prototipo. 


II. INTEGRACIÓN DE LA ESTRUCTURA PLATAFORMA-GRÚA 


Como ya se mencionó, el presente trabajo ha sido desarrollado con el fin de aportar los conocimientos 
adquiridos en el tema al resto de la comunidad de la RERYM IPN, por lo tanto y considerando las conocimientos 
básicos y a nivel técnico de los participantes, el interés principal se enfoca en realizar operaciones básicas de arranque 
y paro del prototipo por medio de adecuaciones eléctricas para en un futuro proponer el control formal para la 
operación de la propuesta final, para lograr el objetivo se retomaron e integraron componentes como lo es una 
caminadora a la cual se le agrego una grúa con arnés y un barandal con el fin de mostrar el funcionamiento de un 
prototipo como los que existen actualmente. 


Pero para lograr dicho objetivo, se realizaron investigaciones de propuestas existentes, de las cuales se consideró 
como una de las más importantes la que se presenta en [7], puesto que en esta se muestra un análisis exhaustivo de 
diferentes sistemas robóticos utilizadas que se emplean en la rehabilitación funcional de miembro inferior, en este 
breve compendio se describen 50 dispositivos desarrollados hasta el año de su publicación en 2014, estos fueron 
clasificados en tres a) robots de aplicación clínica o prototipos, b) de tipo exoesqueleto y c) sistemas híbridos 
(sistemas de efector final); se recomienda leer detalladamente este articulo pues es la base principal de la cual se tuvo 
un concepto general de los diferentes sistemas que existen, ya que pueden ser fácilmente ubicados en tablas con las 
que se especifican detalles importantes como el nombre, desarrollador, tipo de terapia, posición del paciente, 
articulaciones o grados de libertad con que cuentan, tipo de robot, estado de desarrollo entre otros. Con este artículo 
se inició con la búsqueda en específico de algunos de los prototipos mostrados, ya que al ser un compendio esto 
facilito la elección final para la propuesta a presentarse mas adelante. 


De este trabajo se decidió enfocarse en el análisis de algunos sistemas, especialmente en los que se describen y 
detallan a continuación; en [8,9], el proceso de rehabilitación por locomoción es realizado por medio de una ortesis 
robótica, esta se encuentra adaptada como un solo dispositivo de marcha, el cual denominaron como LOKOMAT, con 
este se obtienen los cálculos correspondientes para las terapias y se reportan las pruebas de simulación por medio de 
algoritmos automáticos de adaptación de patrones de marcha, con estos resultados validan la importancia del empleo 
de este tipo de terapias. Mientras que en [10], se trata acerca del exoesqueleto LOPES y lo que denominan como una 
relación viable de un dispositivo implementado en la marcha, estos resultados fueron reportados por medio de la 
realización de pruebas en rehabilitación, en las que se concluye que cumplen con la asistencia en la marcha. Por otra 
parte en [11], se muestra el diseño de otro tipo de exoesqueleto para la asistencia y entrenamiento de la marcha en 
terapias de rehabilitación de pacientes con deficiencias motoras, centrándose en el caso de lesiones sufridas después de 
un accidente cerebrovascular o de una lesión de la medula espinal, para ello se diseñaron pruebas de validación por 
medio del empleo de dos exoesqueletos GBO y Alex, el cual además es motorizado. Otro dispositivo de tipo 
exoesqueleto revisado corresponde con [12], el cual funciona cuando el paciente camina sobre un tapiz rodante el cual 
puede estar o no apoyado por medio de un sistema de suspensión, este fue probado por medio de experimentos 
clínicos, previendo varias consideraciones a futuro como un estudio con mayor número de pacientes. Otra referencia 
de gran importancia basada en mecanismos que aporten cierta ayuda mediante los procesos de marcha, pero sobre 
todo que cumplan con el análisis de pacientes normales contra algunos que han sufrido algún daño, a partir de este tipo 
de estudios se han podido obtener resultados favorables en pacientes que después de cuatro semanas de entrenamiento 
diario han recuperado parte de esta movilidad mediante el empleo de este tipo de prototipos, como puede describirse 
en [13]. 


Otro sistema desarrollado es GE-O [14], este permite que los pacientes a rehabilitar la marcha, este en particular 
fue diseñado como un sistema de efector final, el cual a partir de las trayectorias de las placas del pie para ser 
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programadas en el mismo, lo cual permite obtener simulaciones antes de la práctica incluyendo subir y bajar 
escaleras, para lograr estos patrones de activación muscular del miembro inferior de sujetos con Hemiparesia se 
coloca al paciente en el dispositivo y se verifica el avance en con la máquina. Gait trainer [15], son prototipos 
diseñados por Rifton con una variedad de desarrollos que permiten apoyar al paciente con alguna deficiencia 
neurológica, este distribuidor cuenta con diversos desarrollos enfocados desde el entrenamiento de la movilidad 
temprana hasta soportes para personas adultas, es importante mencionar que esta empresa también ha realizado 
investigación detallada de las aportaciones de los prototipos que distribuyen siendo de gran interés el articulo 
presentado en [16], donde se hace referencia a la importancia de la rehabilitación de la marcha en niños ya que esto 
les ayuda a mejorar su adaptación con su entorno y lo que denominan modelos terapéuticos, entre otros estudios más 
publicados por ellos mismos. 


Como se ha mencionado con anterioridad existen gran cantidad de sistemas robóticos empleados como apoyo en 
la realización de terapias que permitan mejorar el proceso de aprendizaje de la marcha. En el caso del presente 
trabajo y con el fin de validar las opciones propuestas de arranque y paro de un sistema similar, se opto por combinar 
una estructura del tipo de LOKOMAT, la cual está enfocada en la marcha del paciente y su estructura esta compuesta 
por una banda de trote y una grúa con arnés, otro dispositivo similar es el sistema robótico GE-O y el Gait trainer 
anteriormente descritos. 


Para ello se dividieron como dos componentes principales para la integración de la propuesta final, la primera 
corresponde con la plataforma de marcha (caminadora) con dos barandales de seguridad que fueron adaptados, y la 
segunda con una grúa y el arnés. Un primer bosquejo de la idea se muestra en la Fig. 1 correspondiente con el dibujo 
acotado de las vistas del prototipo, con acotaciones en centímetros. 





Figure 1. Dibujo en isometrico del prototipo propuesto (Acotaciones en cm). 
A continuación se describirán con mayor detalle en qué consisten ambas estructuras, así como las 
consideraciones y dispositivos empleados en el diseño del prototipo. 
A. Plataforma 


La plataforma que se decidió emplear con el fin de validar las pruebas eléctricas de arranque y paro, corresponden 
con las de una caminadora que tiene integrada una tarjeta de control MC-60 y un potenciómetro lineal con el fin de 
regular la velocidad de la misma durante la puesta en marcha. A esta se le agregaron unos barandales de seguridad, 
con la consideración de que al tratarse de niños con PCI estos deberían tener un apoyo durante la terapia de marcha. 
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B. Grúa ortopédica con arnés 


Al emplear una caminadora de este tipo, se observó que era necesario adaptarle una grúa como las que se utilizan 
en ortopedia, en conjunto con un arnés de sujeción para el niño que recibirá la terapia física de rehabilitación, esta fue 
soldada y adecuada a la caminadora, la forma de operación es mediante poleas las cuales permiten ajustar el arnés de 
acuerdo con el tamaño del niño. Sin embargo es importante aclarar que en esta primer etapa, ha sido contemplado 
reutilizar los elementos con los que contaba la caminadora inicialmente, esto con el fin de que los alumnos 
involucrados se familiarizaran con el funcionamiento del motor y los rodillos en conjunto. Dando un mayor énfasis en 
la conformación de la estructura mecánica, por ello el diseño final en SolidWorks) se muestra en la Fig. 2. 








Figure 2. Prototipo diseñado. 


III. ELEMENTOS ELÉCTRICOS ELECTRÓNICOS DE LA PLATAFORMA DE MARCHA 


Como ya se ha mencionado, en cuanto a la estructura mecánica, y la adecuación de la grúa, arnés y barandales 
primero fue necesario seleccionar los componentes apropiados que permitan el funcionamiento de la caminadora. 


La plataforma de marcha está integrada principalmente por una tarjeta de control MC-60 (Fig. 4) cuya función 
principal es la de controlar la cinta transportadora sobre la cual se colocara al paciente. 


En esta primera etapa se decidió trabajar con los elementos propios de la caminadora con el fin de poder hacer las 
primeras pruebas de funcionamiento del prototipo. 





Figure 3. Tarjeta de controlador MC-60. 
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La tarjeta de control MC-60 del motor permite la regulación de la velocidad, puesta en marcha y paro de la 
caminadora por medio de los diferentes dispositivos electrónicos con los que cuenta. 


La tarjeta está integrada por una sección donde se encuentra ubicada una fuente de alimentación regulada que va 
de los 12 VCD a los 120 VCA la cual tiene integrada un limitador de corriente cuya característica principal es la de 
limitar la cantidad de corriente a la carga de la caminadora para evitar daños bajo las pruebas realizadas. 


También consta de un arranque suave que puede controlar la tensión del motor de forma que esta aumente 
gradualmente durante la puesta en marcha, esto significa que el motor se pone en marcha suavemente y que los 
esfuerzos mecánicos y eléctricos se reducen al mínimo y esto permite también una parada suave. 


Tiene varios leds que se utilizan para señalización de algunas funciones, las principales que se emplearon y su 
correspondiente indicación se describirán de la siguiente forma: 


e LED6 - es la activación en el controlador, si este no está activado, indica que no hay tensión que enviar al 
motor. Este LED puede variar la intensidad del brillo en función de la configuración de la velocidad. Si este, 
no se enciende cuando la llave de seguridad se inserta y el LED7 está encendido, el controlador tendrá que ser 
reemplazado. 


e LED” - indica que una señal de control de velocidad se está recibiendo desde la consola. Este led parpadea 
cuando se recibe una señal de velocidad. Si este no se enciende cuando la velocidad se fija por encima del 
valor de O km/h, debe encenderse el LED11, con lo cual se estaría indicando un problema con los cables o 
alambres de velocidad de la consola. 


e  LEDI1l - indica que el controlador está dando salida a 12 Vcc para el potenciómetro de velocidad. Si este no 
se enciende cuando se aplica voltaje, entonces de debe reemplazar el controlador ya que indica de una falla 
mayor. 


e  LED16 - "CUR LIM". Este se ilumina cuando el amperaje de la máquina para correr está cerca del límite de 
corriente fijado, indicando de una posible falla a los diferentes sistemas. 


Algunos otros detalles de interés de la tarjeta son el potenciómetro de tipo lineal (Fig. 4) y los diferentes 
componentes que han sido empleados son descritos con mayor detalle en [17]. 





Figure 4. Potenciometro lineal empleado. 


El potenciómetro lineal tiene las siguientes características técnicas: Rango desde 35mm hasta 950mm. Linealidad 
desde 0.2 hasta 0.075%. Salida: Resistiva de 0 a 10kQ, este dispositivo nos permite variar la velocidad de la 
caminadora que va desde 0.05 km/h a 10km/h. 


Por otra parte el motor empleado en la caminadora se muestra en la Fig. 5, este tiene como característica 
principales que al alimentarse con un voltaje máximo de 95V ¿y corresponde con una velocidad de 10 km/h, mientras 
que con el voltaje mínimo 20V¿p la velocidad seria de 0.05km/h, esta es regulada por medio del potenciómetro 
acoplado. 
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Figure 5. Motor de corriente directa. 


Este motor trabaja con una potencia de 1 HP (caballo de fuerza), lo cual le propicia que la banda transportadora y 
los rodillos giren una vez que desde la tarjeta de control se envíen las señales necesarias para su operación. 


El encendido y apagado de la caminadora se realiza mediante un interruptor miniatura de tipo balancín como se 
muestra en la Fig. 6, cuyas características son de 4 Amperes, 250/127 VCA, de un polo y un tiro con dos posiciones 
(ON-OFF). 


0 


- 





Figure 6. Interruptor miniatura 


Finalmente en la Fig. 7 se muestran todos los componentes eléctricos que integran el prototipo. 





Figure 7. Componentes del prototipo propuesto. 
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En esta seccion se dieron a conocer los elementos eléctricos electrónicos de la caminadora asi como las 
caracteristicas tecnicas de los diferentes dispositivos que se utilizaron en la puesta en marcha del prototipo, para 
conocer las medidas de seguridad que se deben de tener en cuenta según los diferentes elementos eléctricos 
electrónicos que intervienen en el prototipo. 


IV. INTEGRACIÓN DE LOS COMPONENTES Y ENSAMBLE FINAL 


Una vez que fueron revisados y acoplados los componentes electrónicos y eléctricos, se propuso una grúa 
ortopédica y unos barandales adaptados a la caminadora, como ya se mostró anteriormente. La razón principal de esto 
se debió a que por seguridad del paciente en rehabilitación era necesario adecuarle unos barandales a lo largo de la 
caminadora con el fin de que pudiese tener un punto para sujetarse y con ello sentirse seguro. 


Por otro lado inicialmente se había contemplado un sistema de poleas a las cuales se estaría adaptando un chaleco de 
seguridad, que tiene como función principal dar soporte en la espalda del paciente, este por medio de las poleas se 
ajustaría a la estatura del niño en terapia; sin embargo por el momento se ha implementado una estructura con un 
perfil tubular recto (PTR) de 2”x1 '%” (pulgada), de la base del prototipo se encuentra ensamblado verticalmente con 
una altura de 170cm, junto con un trozo formando un ángulo de 90° unido a la parte principal, que servirá para dar 
soporte al arnés, este cuenta con cuatro armellas de 5/16” que sostienen cada una un gancho de seguridad para arnés, 
de donde se sujeta el mismo chaleco de seguridad. 


Por otro lado y considerando darle mayor soporte a la estructura, se colocó otra estructura de aluminio de 4cm de 
diámetro en forma de “Y invertida”, la cual fue soldada a los barandales que se encuentran a lo largo de la 
caminadora. En la Fig. 8 se muestra como se encuentra actualmente el prototipo ensamblado. 





Figure 8. Prototipo ensamblado. 


V, PRUEBAS REALIZADAS 


Al ser un proyecto desarrollado en pocos meses aún hay varias opciones de mejora y modificaciones que pueden 
realizarse a futuro, sin embargo una vez ensamblado el prototipo se realizaron varias pruebas de funcionamiento. 
Estas se limitan únicamente a verificar que la cinta transportadora de la caminadora esta funcionando por medio de 
las variaciones de voltaje que se tienen a través del potenciómetro lineal integrado con la tarjeta de control MC-60; 
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en esta fase inicial se conto con el consentimiento oral de los padres, puesto que las pruebas realizadas son de riesgo 
mínimo y no contemplan la necesidad de toma de muestras biológicas, sin embargo existe confidencialidad con 
respecto al uso y difusión de imágenes de ambos niños que participaron. Es decir, las pruebas se encuentran 
divididas en el caso de dos niños, estas consisten en colocar al niño sobre la plataforma, asumiendo que estos no 
tienen problemas con la marcha que realizan, el objetivo únicamente es comprobar si existe una comunicación 
adecuada de los diferentes dispositivos, para ello se tienen dos sujetos de prueba, el primero es el sujeto A (niña de 5 
años y una estatura de 112cm) se ajusto la velocidad de la caminadora seleccionando el nivel más bajo de intensidad, 
en este caso la velocidad empleada fue de 0.5km/h el cual es equivalente con una tensión eléctrica de 20Vcp. La 
prueba 2 fue realizada con el sujeto B (niño de 12 años y una estatura de 165cm), al cual se le ajusto una velocidad 
mucho más rápida que la del sujeto A, esta corresponde con aproximadamente una tensión eléctrica de alrededor de 
90 Vep. 


Es importante recalcar que estas pruebas corresponden con la primera parte del proyecto final, por lo que los niños 
son clínicamente sanos y su desempeño durante la marcha se considera normal para un niño con esas características, 
sin embargo y de acuerdo a las regulaciones existentes como es el caso de pruebas en niños con PCI, se requieren de 
un consentimiento informado de los padres, así como de uso y difusión de videos o imágenes con autorización de los 
mismos, el cual es avalado por la Norma oficial Mexicana (NOM), según reporta en Instituto Nacional de Salud 
Pública en su sitio de internet (INSP), como puede revisarse con mayor detalle en [18]. Para este caso de estudio los 
padres únicamente aprobaron la participación de los niños en la marcha sobre el prototipo pero no de la difusión de 
las imágenes, motivo por el cual no se presentan. 


VI. CONCLUSION 


Una vez concluida la primera etapa del proyecto, en la cual únicamente se contempla el ensamblaje y puesta en 
marcha del prototipo, puede considerarse que resulto exitoso en su primera fase, ya que se cumplieron con las metas 
propuestas para este trabajo. Estas metas que han sido cubiertas totalmente corresponden con la fase de recopilación 
de información y búsqueda de dispositivos desarrollados (prototipos o patentes) para rehabilitación de marcha en 
pacientes con parálisis cerebral, los cuales por ahora no son diseñados específicamente para niños y solo en algunos 
casos tienen aditamentos especiales extra para este tipo de pacientes. A partir de este análisis detallado se optó por 
emplear la caminadora en conjunto con la grúa, esto debido en gran parte a la fácil manufactura y a una posible 
modificación del mismo, dando cierta libertad de cambiar la misma o alguno de los componentes eléctricos y 
electrónicos que la conforman. En ese sentido la función inicial del proyecto corresponde con la selección y 
adecuación de componentes eléctricos y/o electrónicos para controlar operaciones básicas como lo es el arranque y 
paro de un prototipo de rehabilitación para niños con PCI, en este aspecto y aprovechando la ventaja de tener la 
caminadora con la cinta de trote ajustada, se reutilizo la tarjeta de control de la misma y se le agrego un 
potenciómetro lineal que permitiera la variación de la velocidad de la cinta. Además se tiene un interruptor miniatura 
que enciende cuando el prototipo está trabajando, con lo cual se indica el arranque y puesta en marcha. 


Sin embargo, el desarrollo de este se sigue trabajando con los alumnos integrantes del presente proyecto. Por lo 
que a futuro se espera modificar la etapa de control, mediante la implementación de un controlador programable y su 
etapa de potencia diseñada para esta aplicación, con lo que se espera que al existir fallas no se requiera el reemplazo 
completo de la tarjeta y con eso se simplifiquen la cantidad de componentes empleados en el prototipo actual. 


Otra aportación significativa que puede ser mejorada consiste en la pintura de la misma, puesto que después de las 
pruebas con niños, se planteo la necesidad de tener colores mucho más adecuados y agradables. Otra mejora es en la 
estructura del arnés el cual puede ser mejorado basándonos en la información de los prototipos funcionales que 
existen en el mercado. 
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Control por par calculado para un seguidor solar de 
dos grados de libertad 


Sergio Isai Palomino-Resendiz', Diego Alonso Flores Hernández”, Alberto Luviano 
Juárez? Norma Lozada Castillo? e Isaac Chairez? 


Resumen— En el presente trabajo se realiza el modelado dinámico y control de un Robot Seguidor 
Solar de dos grados de libertad en tareas de seguimiento de trayectoria. El cálculo de la trayectoria 
deseada se basa en el uso de la ecuación de Cooper. El entorno de simulación propuesto 
considera el uso de las propiedades físicas del material mediante la mezcla de un software de 
diseño (SolidWorks) y otro de simulación numérica (Matlab-Simulink). Se utiliza un controlador de 
tipo par calculado, el cual realiza la tarea de seguimiento con buena precisión. 


|. Introducción 


Actualmente el uso y producción de energía limpia (solar, eólica, entre otras) presenta una solución 
favorable a la crisis energética, sustentabilidad e impacto ambiental que el mundo vive, resultado 
de aplicar técnicas convencionales que procesan y transforman combustibles fósiles [1]. La energía 
solar como recurso, es una fuente inagotable útil para producir energía eléctrica (EE) a través de 
sistemas de conversión que implementan mecanismos e instrumentación para orientar dispositivos 
de captación (paneles fotovoltaicos (PV)) en relación a dos ejes (elevación (H) y azimutal (Z)) o 
grados de libertad (GDL) de forma perpendicular al Sol, en configuraciones estáticas o móviles 
(seguidor solar (SS)) [2], mejor conocidas como: 


= Fija: Orientación manual de PV que permanece estática. Su máxima producción de EE 
sucede con incidencia solar directa o en el momento de mayor irradiancia del día. 


=» SS de un eje móvil (1GDL): Orientación manual para H o Z y mediante un algoritmo de 
búsqueda o posicionamiento rota el eje restante respecto a la trayectoria solar (TS). 
Presenta hasta un 30 por ciento de producción mayor de EE en comparación con el fijo 
para igual número de PV [7]. 


=» SS de dos ejes móviles (2GDL): Orientación automática para ambos ejes mediante un 
algoritmo de búsqueda o posicionamiento en relación a la TS. Presenta hasta un 40 por 
ciento de producción mayor de EE en comparación con el fijo para igual número de PV [7]. 


= SS Híbrido: Configuraciones especializadas que utilizan más ejes e instrumentación. Su 
producción es igual o menor al SS de 2GDL, dado que el consumo energético es mayor. 


El diseño y operación de este tipo de sistemas depende principalmente de la incidencia e 
irradiación solar, el número de PV, la calidad de los materiales y el consumo energético asociado al 
funcionamiento del mismo [3], todo con el objetivo de presentar la mayor cantidad de EE 
disponible. Convencionalmente la planeación o generación de trayectorias (ángulos asociados a 
cada eje) que orientan los PV de sistemas móviles, se obtienen de forma activa por el cálculo de la 
declinación solar (DS) y/o el uso de sensores (luminosidad, irradiancia solar, potencial eléctrico) 
implementados en métodos numéricos para micro-controladores o algoritmos computacionales y 
de forma pasiva o analógica mediante globos que contienen ciertos gases que reaccionan a la 
irradiancia solar atados a los PV, aunque este último método es muy poco utilizado por las 
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especializadas y costosas condiciones de operación que involucra [4]. La DS aproxima una TS fija 
sin considerar perturbaciones ambientales (nubes, sombras). Sin embargo, el costo computacional 
y económico es mucho menor en comparación con el consumo energético y los recursos 
necesarios para procesar, en tiempo real, el cálculo de una TS a partir de sensores, que 
dependiendo su calidad, calibración y el algoritmo de búsqueda pueden guiar al sistema de manera 
equivocada o redundante. La comparación en línea de ambos métodos permite obtener una TS 
más fiable, sin embargo, el costo económico y tiempo de procesamiento incrementan de manera 
considerable. 


Adicionalmente, los algoritmos de búsqueda o posicionamiento pueden verse como un problema 
de seguimiento de trayectorias para los mecanismos del sistema (a través de sus actuadores), 
visto éste como un robot manipulador que por medio de técnicas clásicas como el control 
Proporcional Integral Derivativo (PID) y sus variantes, control por modos deslizantes, control por 
par calculado, entre otros, sean reproducidas [5]. Normalmente se eligen actuadores (motores de 
DC) con lector de posición (Encoder) y mecanismos reductores de engrane que bloquean su 
rotación para lapsos donde la actualización de posición no es significativa con el objetivo de 
reducir el consumo energético o rechazo físico de perturbaciones (condiciones del medio). Lo que 
resulta en un modelado dinámico más complejo del actuador y que para técnicas como el control 
PID y sus variantes o el control por modos deslizantes, significa compensar perturbaciones 
asociadas al funcionamiento y dinámica del sistema más el par mecánico (torque) de arranque de 
cada motor para cada movimiento constantemente, acción que implica un gran consumo 
energético en comparación con la técnica de control por par calculado que estima el Par necesario 
y suficiente para cada actuador en el momento que lo requiere considerando dichas condiciones de 
operación. 


En relación al trabajo de Sidek [7], se reportó el estudio e implementación de un controlador PID 
basado en el seguimiento de TS generada por el cálculo de DS con datos obtenidos de un GPS y 
procesados por un micro-controlador PIC18f4431 para un SS de 2GDL. Básicamente la estrategia 
de solución calcula los valores de H y Z, luego realiza una comparación con el valor del Encoder de 
cada motor y actualiza la posición, el trabajo reporta una producción de 27 por ciento de EE mayor 
que un panel fijo. Sin embargo, no se considera el sistema de bloqueo por lo que en el lapso de 
actualización de posición el sistema se mantiene energizado, reduciendo la cantidad reportada de 
EE disponible real. Por otra parte, Huang [8] propuso un método particular de orientación de PV 
para un SS de 1GDL; estableciendo el ángulo del eje H para cada mes mediante 3 rotaciones de Z 
en el transcurso del día relacionadas a una medición de irradiancia solar que determina la posición 
del Sol al amanecer, el medio día y atardecer. Lo anterior incluye un consumo energético reducido 
relacionado al actuador por sistema de bloqueo, el cual se energiza solamente para actualizar la 
posición. El trabajo reportó hasta 38 por ciento de producción mayor de EE en comparación con un 
panel fijo, siendo una opción viable. Sin embargo, la propuesta no considera perturbaciones que 
pueden afectar por mucho tiempo una posición establecida a diferencia de una que puede 
actualizarse y tener un mejor desempeño en términos de producción, sin mencionar la calibración 
constante necesaria del eje H. 


Adicionalmente, Fathabadi y Hassan [9] reportaron él diseño, construcción e implementación de 
un sistema SS de 2GDL para PV mediante DS, el cual obtiene los ángulos para H y Z, que 
actualizan la posición de un par de motores a pasos; el trabajo reporta hasta un 30 por ciento de 
EE disponible final considerando el consumo del sistema. A pesar de contar con mecanismos de 
engranes asociados a cada eje, el uso de motores a pasos involucra un consumo energético 
innecesario para mantenerlos en su posición además de que cada movimiento no es exacto sino 
aproximado en relación tamaño de paso. 


La mayoría de las propuestas anteriores no consideran la dinámica del sistema mecánico. Es por 
ello que, en esta propuesta, se reducirá el consumo energético en el sistema de seguimiento 
mediante la implementación de un controlador por par calculado, que asegure el seguimiento de 
trayectorias resultantes del cálculo de la declinación solar sin realizar acciones de compensación 
de dinámicas no modeladas. Adicionalmente, se considerarán actuadores con mecanismos 
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reductores de engrane, logrando mediante los bloqueos de posición un menor consumo en los 
actuadores, lo que resultara en una cantidad de EE mayor disponible utilizando la configuración 
con mayor producción. 


El resto del trabajo se presenta de la siguiente manera: la Sección ll proporciona una descripción y 
desarrollo necesarios para el modelado de la propuesta de un seguidor solar de dos grados de 
libertad, además del desarrollo e implementación de un control por par calculado que asegure el 
posicionamiento correcto de los ejes siguiendo la trayectoria generada por el método numérico del 
cálculo de la declinación solar. En la Sección lll se presentan las simulaciones numéricas mediante 
el uso de SolidWorks y Matlab a través del entorno de simulación Simulink-SimMechanics y, 
finalmente, se establecen conclusiones y propuestas de trabajo a futuro. 









Superficie 


Eje de 


Elevación (180* 





Eje Azimutal 
des 
Fig. 1: Seguidor Solar de dos grados de libertad. 


ll. Preliminares 


En esta sección de presentarán las herramientas necesarias para el desarrollo del presente trabajo 
en el siguiente orden: modelo dinámico, control y generación de trayectorias. 


Notaciones 


Para este trabajo se considerará R”*™ como el espacio de matrices reales de n renglones y m 
columnas. Se adoptará la siguiente notación c; := cos(q;),s; := sen(q;) respectivamente. 


II-A. Modelado dinámico 


Para obtener el modelo dinámico del robot ([10], [11], [12]), es necesario calcular primero el 
modelo cinemático directo por la metodología de Denavit-Hartenberg (D-H) y el Jacobiano 
asociado a cada centro de masa, dado el enésimo eslabón, J, denotado por su respectivo 
Jacobiano geométrico. 


Parámetros de D-H: La configuración del robot es revoluta- revoluta (RR) en cadena cinemática 
abierta; por las reglas de D-H se propone la localización de marcos coordenados y centros de 
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masa para cada grado de libertad además de un marco de referencia o tierra en un modelo 
equivalente descritos en la figura 2. Donde: Ox p¥oZ) es el sistema de referencia inercial del 
modelo, 0;x;y;z; los marcos coordenados, mi masa del eslabón, q; ángulo de junta, l; longitud 
respectiva de cada eslabón para i = 1,2, siendo i el eslabón asociado. 





(a) (b) 
Fig. 2: A la izquierda, se muestran los marcos coordenados obtenidos por la convención de D-H. A la derecha, 
se hace hincapié de los centros de masas. 


Por convención, O, = [000]? y zo =[001]’ . Se tomarán 1, como la distancia del marco inercial 
al centro de masa del eslabón 1, así como l, como la distancia del marco 0, x, y,z, al centro de 
masa del eslabón 2. Cabe mencionar que la distancia |, dada la propuesta de localización de los 
marcos coordenados y centros de masa puede ser depreciable sin afectar el desarrollo del cálculo. 
Así siguiendo la metodología de cinemática directa de D-H, se obtienen los siguientes parámetros 
(ver tabla 1): 





Tabla 1. Parámetros de Denavit Hartenberg del seguidor solar 


Así, la matriz de transformación homogénea que relaciona el marco del efector final O,x yz, 
respecto al marco inercial está dada por 


To =AjBs 
—C2581 SiS & ly Sy 
C1C2 =S? Si hac 
S2 Co 0 lS» (1) 
0 0 0 1 
Con 
— $1 0 Cy 0 Co —89 0 L,C) 
c 0 s 0 So iG. 0 hbs 
A, = 1 1 , A= 2 292 
: 0 1 0 0 2210 c 1 0 
0 0 0 1 0 0 0 1 
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Jacobianos geométricos: Se obtiene el Jacobiano geométrico asociado al centro de masa del n- 
ésimo eslabón (con posición O... ), denotado por J,, ¡R*%? y sus respectivas divisiones en velocidad 
lineal y angular, descritas como Jyn R$*? y Jw, R$*?, se tiene para n = 1,2. 


Fun (2) 
n= [i 
Esto es 
J = te = m x (Omi ~~ Oo) o 
A w1 Zo 0 
p= 2 = ij X (Ocmz — 90) Z2 X (Ocmz — 00) 
w2 Zo Z1 


Usando A,,7/ y de la geometría de la figura 2, se tiene Osmi = 0, = Oo, Zo = [c1 si 0% y Oom2 = 
[Lc ls 0]’. Calculando entonces lo anterior: 


0 0 0 0 
Jul [o | Ta = [o o 


0 0 1 0 (3) 
—=l2C1S2  l281S) O Cc, 
Jv2 = Hise “hasal Jw2 = [o | 
0 LG 1 0 (4) 
Luego 
0 0 -bcs 148482 
0 0 —l)51C7  —l2C1S7 
_|0 0 _ 0 LoCo 
J a 0 Ol’ h — 0 Cs 
0 0 0 S4 
1 0 ji 0 
Modelo dinámico general: Por convención [11], el modelo dinámico general tiene la forma: 
D(4)4 + C(q,q)q + G(q) =u (5) 


Donde 
e q, variables y velocidades de junta, respectivamente. 


e D(q)e R”? representa a la matriz de inercia, la cual es simétrica y definida positiva. 


2 
D(q) = y Mi pvi + RR Jwi 


1=1 


(6) 


e Rie R?®, es la matriz de rotación A,,(i = 1), T = A,A2(i = 2) 
respectivamente. 


e I, €R**%, es la matriz de componentes inerciales. Por hipótesis, para nuestro 
caso se define como una matriz diagonal, tal que la simetría y dinámica del 
mecanismo sea ideal. Al final dichas componentes de la matriz no 
contempladas serán compensadas por el controlador, vistas como una 
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perturbación. 


Li 0 0 
I; —|0 Lyi 0 
0 0 L 


e C(q,ġ)eR?%? es la matriz de fuerzas Centripetas y de Coriolis cuyos elementos están dados por 
(7), con C;;,, los llamados símbolos de Christoffel. 


(7) 
C(k,j) = `> Cindi 
l 


e G(q)eR? es el vector de fuerzas de gravedad o pares gravitacionales obtenido como el 
gradiente de la energía potencial. La i-ésima componente de G(q) está dada por: 


ðP (8) 


e ue R? es el vector de par o torque de entrada del sistema su propuesta es generalizada. 


= ht we) (9) 


Para el caso de interés, de (3) y (4), la matriz de inercia tiene la forma: 


7 cos? (qz)(mz13 + Dz) + Lysen? (q2) + Ly1 0 
D(q) = 2 
0 m-l5 + bz 


Los símbolos de Christoffel, elementos de la matriz de Coriolis C(q,q), se definen a partir de los 
elementos de la matriz de inercia D(q). Esto es: 


1 Odx; Ody Adi (10) 
Cijk = 51 ce 
2 09 ôq; Ox 








Luego 














1(0dí, dı dd, 1 (0d,, 
ps e a 
2t 0q1 01 01 2 0q1 
1(0d,, 0d, dd, 1 ôdi 
cme Hes Se E 
2 0q1 0q1 092 2 092 
E {8 0d; a) E {4} 
2 01 042 01 042 








— “211 








g 
1(0d,, 0d, dz 
C == === = = 

sad al dq, 09, i] 0 = C212 
= {s+ ôdi 0d, == 
A 02 091 091 _2 02 A 
1(0d,, Od,, 0d» 

f l = 0 = C422 

















212 2 agy 0, 0 
1 (0d 0d 0d 
221 =5| 12 12 _ 22} = 9 
THREE. 
os =5| 22, 22 2} = 9 
2 09), 042 092 
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Con lo anterior, la matriz de Coriolis (7) es: 


a JO oa) 
“G9 =lc(2,1) c(22) 
Donde 
C(1,1) = C1111 + Co1192 = cos(qz) sen(qz) (ml + l2 — Tox) 42 
1 ! 
C (1,2) = C1211 + C2212 = — 7 sen(2q2) (m: — Ly2 + lox) 
C(2,1) = C11241 + C21242 = cos(qz) sen(qz) (ml Page Tox) M1 
C(2,2) = Cy22d1 + C222ġ2 = 0 
Por otra parte, para el vector de G(q) de fuerzas gravitacionales (8), se considera la energia 
potencial 
2 


P = y» MiJTci 


1=1 


Con ġ = [0 0 gl', r.; = 0;, para i = 1,2. Asi 


aa orale sl 


Il-B. Control por par calculado 

El control por par calculado (CTC Computed Torque Control por sus siglas en inglés) es un 
controlador en lazo cerrado que es no lineal en las variables de estado respecto a un sistema 
asociado. La mayor ventaja del enfoque es que presenta estabilidad global así como una 
linealización exacta por realimentación del sistema, cuando éste es no lineal [11], [13]. Dada una 


trayectoria deseada q* para el modelo dinámico (5), el control u por par calculado en su forma 
general es: 


u = M(q)q + C(q,q)q + +B(q) + G(q) (11) 


Donde 
e q, variables y velocidades de junta, respectivamente. 
e M(q)eR?? es la matriz de inercia más la inercia efectiva del motor, el cual está 


gobernado por la siguiente ecuación 
M(q)4 =D(q)14 +J, J= diagíJ J2} ( 12) 


Jı, J2 son las inercias de los actuadores (motores DC) asociados a cada junta. 


e B(q) es la matriz de fricción seca y viscosa. 


La propuesta de ley (11) supone que dada una posición y velocidad del actuador, se cancelen todas las no 
linealidades y por tanto, se tendrá el par necesario para aplicarlo a la inercia del actuador. Sustituyendo el 
control (11) en el modelo dinámico general (5) se tiene 


M(q)q = M(q)q* 
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Por sustitución se tiene que M(q) es definida positiva, y por tanto, es invertible; luego g = q*. La 
relación anterior consiste en 2 controles de cadenas de integración de segundo orden, las cuales 
se pueden resolver mediante controles de tipo PD prealimentado. 


Luego se tiene 


u = M(q)lq* — Kp(q — q*) — Kp(q — q4%)] + CCa 49) +G(q) Kp, Kp € R°*? 


Pictoricamente el lazo de control puede verse en la figura 3. 










Ve eee ae ee a “om 
| 
: Control 
| Trayectoria deseada 
| Matriz Inercia | 
i I 
| | 
t i 
| | 
z I 
| | 
= I 
r A 
| 
€ 
| - 
n Matriz Inercia Inversa Integrator | Trayectoria real 
| Matriz Coriolis | 
i 
| 
| Vector Gravedad RO bot | 
4 
| : 
nn  — 


Fig. 3: Esquema gráfico del lazo de control. 


[l-C. Generación de trayectorias 


La trayectorias requeridas q* para el seguimiento del robot de dos grados de libertad, están dadas 
a través de las ecuaciones de Cooper [6]. Dicha relación matemática, es una propuesta 
aproximada para la descripción el movimiento relativo del sol respecto a la tierra con respecto al 
sistema coordenado horizontal. Los elementos para determinar dicho movimiento son 


e Declinación solar (6) que es el ángulo generado entre la dirección de los rayos solares y el 
ecuador. 


e Día del año (n) el cual toma valores de 1 a 365. 
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248 +n (13) 
ô = 23.45" sen | 360° (==) 


365 


La relación de Cooper provee, dado un día del año la condición inicial del movimiento solar. 





Fig. 4: Orientación solar. 
Para la completa determinación de la posición solar, se requieren los ángulos respecto al ecuador 
en sistema coordenado esférico dadas la longitud L y latitud A del sistema coordenado local (punto 
de observación). 


e Angulo horario t, es el desplazamiento angular del Sol sobre el plano de la trayectoria solar 
dada una hora de observación. 
t = (12 — hora)15° , donde hora = 0 en el cenit. 


e Angulo de eje de elevación (h) es generado por el rayo solar en el plano vertical. 
sen (h) = (cos(A) cos(6) cos(t)) + (sen(A)sen(6)) 


e Angulo de eje azimutal z es el que se forma de la proyección del sol sobre el plano 
horizontal con la dirección sur. Toma el valor de O cuando es el medio día. 


B sen(h)sen(A) — sen (ô) 
A cos(h) cos(1) 


Así los valores de h y z darán la trayectoria buscada q* descrita como 
[M4] _ [2 (14) 
Yo i 7 A 
Ill. Resultados numéricos 


Utilizando el Software de diseño SolidWorks y el ToolBox- SimMechanics de Matlab se desarrollo 
un mecanismo equivalente al planteado, cuyas características se exportaron al entorno Simulink, 
donde se realizó la simulación numérica del controlador con la trayectoria propuesta. La figura 5 
muestra el mecanismo realizado, en el entorno de SimMechanics, donde se aprecian los dos 
grados de libertad. Éste se encuentra compuesto por tres piezas, una base con masa de 1 
kilogramo (kg), el eslabón 1 con una masa de 1 kg y finalmente, el eslabón 2 que agrega una 
pieza en su extremo equivalente a un PV, resultando así una masa total esta última pieza de 2 kg . 
La generación de trayectoria, así como el controlador propuesto se programaron en el entorno 
Matlab Simulink, haciendo el cálculo para el intervalo t e [0,10] s. 
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Fig. 5: Modelo equivalente en SimMechanics. 
Las ganancias del controlador fueron las siguientes: 


oe Pl Ge i 


Con un periodo de muestreo de 0.0005 s. El esquema a bloques de la simulación se presenta en la 
figura 6. 


a 0 #4) O 8 5 0 1008 {> = ] | 


Modelo equivalente SimMechanics 
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Fig. 6: Diagrama a bloques del programa de control en el entorno de SimMechanics. 
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En las figuras 7 y 8 se muestran los resultados de seguimiento para los ejes azimutal y de 
elevación, empalmando las trayectorias reales y deseadas, las cuales se mantienen en una 
cercanía. Adicionalmente en las figuras 9 y 10 se muestra para las gráficas anteriores el error en 
cada eje respectivamente. Dado que el controlador se desarrolló integramente en Simulink, y el 
modelo realizado se exportó directamente del entorno de SolidWorks, el modelo obtenido está bien 
validado, lo cual permite una exportación a un entorno real con ajustes menores. 


Seguimiento de trayectoria eje Azimutal 


2 
1 
go —«q 
(Y -T 
-1 ad 
“2 ve p- 
3 — - 
| | 
O 1 2 3 4 5 6 7 8 9 10 


Tiempo 


Fig. 7: Seguimiento de trayectoria eje azimutal. 


Seguimiento de trayectoria eje de Elevación 





0 1 2 3 4 5 6 7 8 9 10 
Tiempo 


Fig. 8: Seguimiento de trayectoria eje de elevación. 
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Error de seguimiento eje Azimutal 





— Error (q1*- q1) 


-2 
-2 5 
0 1 2 3 4 5 6 7 8 g 10 
Tiempo 
Fig. 9: Error de seguimiento (eje azimutal). 
107 Error de seguimiento eje de Elevación 
0 





|— Error (q2* - q2) 






Tiempo 


Fig. 10: Error de seguimiento (eje de elevación). 


IV. Conclusiones 


Se logró el modelado dinámico, generación de trayectoria solar, así como la implementación del 
control por par calculado de un sistema robótico seguidor solar de dos grados de libertad. La 
estrategia propuesta se comprobó mediante un esquema de simulación en SimMechanics, el cual 
permite estimar los pares cercanos a un esquema real al utilizar las propiedades mecánicas de los 
mecanismos involucrados. Como trabajo futuro se propone la implementación experimental de la 
estrategia propuesta, así como la implementación de estrategias de minimización energética en las 
tareas de control, así como trabajar en esquemas alternos de generación de trayectorias que 
incluyan entornos como nubes que puedan afectar las trayectorias deseadas reales. 
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Abstract— Synthesis and analysis of a fractional-order sliding mode control (FOSMC) for a perturbed 
double integrator are addressed. The novelty of the paper resides in that a fractional-order sliding mode 
surface, with order less than one, is proposed to ensure the asymptotic stability of a second order system. 
Compared with conventional sliding mode scheme, the proposed method decreases the frequency and the 
amplitude of the control signal (also known as chattering); consequently, the overheating and deterioration in 
mechanical components of the actuator may be reduced. Despite dynamical models described by fractional- 
order integro-differential equations allow a straightforward synthesis of fractional-order controllers, in this 
paper the integer-order differential equation of the plant is used instead of its fractional version thus avoiding 
an extra step in the control design. Moreover, it is shown that the use of a fractional sliding mode controller 
attenuates the chattering, preserving the robustness and finite-time reachability properties of sliding mode 
controllers. Numerical and experimental results demonstrate the effectiveness of the proposed method in an 
uncertain DC motor with friction. 


INTRODUCTION 


Fractional-order systems and controllers are an emerging research field in engineering problems. 
Fractional calculus, with more than 300 years old of history, 1s a generalization of ordinary differentiation 
and integration of arbitrary order. During past three centuries, this subject was devoted to mathematicians. 
In the last few years, however fractional calculus has been-applied to several fields of engineering, science 
and economics [1]. 


In the last decades the use of fractional-order integro-differential equations has attracted considerable 
research interest for nonlinear control design and analysis for complex systems including infinite- 
dimensional dynamical systems. Some physical systems which are better modelled by fractional-order 
differential equations are irrigation systems [2], diffusion processes [3], ionic polymer-metal composite 
actuators [4], among others (see, e.g., [5]). The extra degrees-of-freedom from using of fractional-order 
integrator and differentiator made possible to further improve the performance in comparison with 
traditional integer order controller. 


Robust control design for plants governed by fractional-order differential equations has become a 
developing area for the control community. For example, Jakovljevic et al. [6] deals with applications of 
sliding-mode-based fractional control techniques to address tracking and stabilization control tasks for 
some classes of nonlinear uncertain fractional-order systems. Kamal and Bandyopadhyay [7] design a 
globally exponentially stable controller for fractional-order chain of integrators based on contraction 
theory. Aguila-Camacho and Duarte-Mermoud [8] make an analysis of three classes of fractional 
differential equations appearing in the field of fractional adaptive system where Caputo definition [9] plays 
an important role in the analysis. Tepljakov ef al. [10] make applications for a mechanical system using a 
fractional PID controller. 


Concerning variable structure controllers, which are recognized by its robustness properties, Vinagre 
and Calderon [11] propose a controller with the fractional-order control law and sliding surface for a 
double integrator structure. Huang et al. [12] apply the fractional calculus into the sliding surface design 
for the speed control of a permanent magnet synchronous motor. Muñoz-Vazquez et al. [13] introduce a 
fractional sliding surface of commensurable rational order 7 to control Euler-Lagrange systems. Efe [14] 
propose the fractional order sliding mode control with the reaching law approach. Summarizing, the 
FOSMC achieves better control performance with smaller chattering level with respect to conventional 
sliding mode controllers but preserving the robustness against external load disturbance and parameter 
variations [15], [16]. 


In [17] Zhang establishes the three main approaches to counteract the chattering phenomenon in sliding 
mode control (SMC) systems proposed in the last two decades: continuous approximation of the relay or 
introduce bounder layer near the sliding surface [18], use an asymptotic state-observer to confine 
chattering in the observer dynamics bypassing the plan [19], use higher-order or second-order sliding mode 
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control (SOSMC) algorithms [20]. However, the drawbacks of the continuous approximations and of the 
observed-based approach are the deterioration of accuracy and systems robustness, respectively. 


Sliding mode controllers are well known for its ability to deal with uncertain systems. Nevertheless, 
SMC are tarnished by the so-called chattering effect. Chattering may be destructive to real systems, thus, 
the use of a continuous approximation of signum function is considered to counteract its effects. This 
approach attenuates chattering at the expenses of a lost of robustness. Fractional order controllers, 
however, reduce the chattering while preserving robustness properties. 


In this work, the synthesis and analysis of a fractional-order sliding mode control for a perturbed 
double integrator was addressed. In contrast to the above mentioned relevant literature, the novelty of the 
paper resides in that a fractional-order sliding mode surface, with positive order less than one, is proposed 
to ensure asymptotic stability of the equilibrium point of the double integrator. Moreover, the idea behind 
the paper is to increase the frequency and decrease the amplitude of chattering in the control input, , 
without losing the robustness and finite-time reachability properties of the sliding mode controllers. 
Despite fractional-order controllers can be straightforwardly synthesized from dynamical models described 
by fractional-order integro-differential equations. In this paper the integer-order differential equation of the 
model of the plant was used instead of its fractional version thus simplifying the control design. 


This paper is organized as follows. We start in Section II, recalling basic definitions about fractional- 
order derivatives and integrals. In Section HI, the problem statement and synthesis and analysis of the 
fractional-order sliding mode control is developed for a perturbed double integrator. In Section IV, the 
performance of the controller is evaluated in a numerical and experimental study with a CD motor. Finally, 
conclusions are provided in Section V. 


Notation: We let N denote the set of positive natural numbers and Nọ denote the set of non-negative 
integers. We let R and C denote the set of real and complex numbers, respectively. 


I. BASIC DEFINITIONS 


In this section we present definitions which play an important role in theoretical part of the paper. They 
will be used in the analysis of the forthcoming section dealing with the synthesis of the fractional-order 
sliding mode controller. 


The fractional-order derivative operator, denoted by D , of order is defined as 


A 
L R(A)>1 
D’ 0, D*= 1 R(4)=0 (1) 


[. (dt)? R(A)<1 














where a and í are the limits of the operator. Generally, @ e 


A. Definitions of Fractional-Order Derivatives and Integrals 


Throughout, the following definition for the fractional-order derivatives, introduced by Caputo [8], will 
be used: 


(n) 
DEOD DSO = NE (2) 


(t— x)" A 


where f(x) with xER is an arbitrary integrable function, (a —n) is the gamma function, 
O<n-l<a<n, and t > 0. According to the latter definition, the fractional-order derivative of a real 
number C is 


D*C=0, a > 0, (3) 


and the following property 
D“Cf(x)=CD" f(x),  a>0, (4) 


also holds. 


The Caputo’s definitions is the most used for fractional-order integrals and derivatives for its relevance 
in automatic control because it takes into account the initial conditions of the system [21] been realistic 
from the physical point of view. Another advantage of the above definition is that initial conditions of its 
Laplace transformation have the same shape than the integer-order differential equations. Moreover, 
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derivatives and integrals of fractional-order provide a powerful tool for the description of properties of 
heritage and memory of different substances [22], [23], being an advantage with respect to the integer- 
order analysis. 


According to Caputo’s definition, the fractional-order derivative can also be expressed as the 
combination of an integer-order derivative and a fractional-order integral, that is, 


D1FOUL™™ DFO), (5) 


where I denotes the fractional-order integral operator and m is a positive integer value. The Riemann- 
Liouville definition [24] is considered for the fractional-order integral that is 


MFO =f Fede 6) 


























Thus, the Laplace transformation of Caputo fractional-order derivative of a function f(t):O0 HU is given 
by 


L{D7f@}=L{I""D" sO} 
= g 000 FO) — gia po o| (7) 


=s°F(s)- Ys" f'O) 


with m—l<a<m. 


B. Mittag-Leffler Function 
The Mittag-Leffler function defined as 


(k+m)! zk 


(m) E ` E oo 
EnO k! T(Bk+Bm+n) a 





is a generalization of the Euler function for fractional-order integro-differential equations. Here, m is the 
integer order degree of Mittag-Leffler function derivation, z € C, and parameters B and n are the 
fractional-orders of the function derivation. 


The procedure for finding a solution of a fractional-order integro-differential equation, consists first 
into apply the Laplace transform to the equation in question and then group it into terms according to the 
number of poles of the system. Finally, the solution, which depends on the Mittag-Leffler function, is 
obtained after using Laplace anti-transformation. 


Il. FOSMC OF A PERTURBED DOUBLE INTEGRATOR 


The purpose of this Section is to synthesize a fractional-order sliding mode controller for a perturbed 
rotational double integrator given by 


q=u+w (9) 











where q(t) € R denotes the angular position, g(t) € R is the angular velocity, u(t)¢U is the control 
input, t 2 0 is the time variable, and w(t) e UU is the external disturbance. 

















The control objective is to drive the position g(t) and the velocity g(t) to the origin, that is 


be 


q(t) | 


lim 


too 











=0 (10) 


for arbitrary initial conditions g(0), 4(0) in spite of the presence of external perturbations. 


The following fractional-order sliding mode controller 


2-a 


u(t)=—nD ? q(t)—mD'“q(0)- pl Ë sign(S@), (11) 
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is proposed to satisfy the control objective where S is the fractional-order sliding surface defined as 


S =D%q(t)+nD’ q(t) + mq(t), (12) 


with m>0,0<a<1,0<B< 1/2, and0<06d<1. 


A. Stability Analysis of the Origin 
First, we need to verify that trajectories tends to the origin once the trajectories reach the discontinuity 
set S ={(q, gy €17:S(qg) =S(g) =o} that is (9,9) eS. In other words, we need to show that the 


solution of the fractional-order differential equation 

D%q(t)+nD’ q(t) +m A =0 (13) 
under the initial conditions g(0) = b, and q(0) = by, reach the origin asymptotically. It is assumed that 
trajectories are initialized within the set S, that is, (g(0), g(0))’ eS. 


By applying the Laplace transformation to (14) we have 


s“Q(s) 5" q(0) 5“ G(0) +ns*Q(s) ns" "q(0) + mAs) =0 


then, 
bso + bso? + bs?” 
NE E 14 
26) s* +ns? +m a 
For simplicity, let us define a = 26 therefore the latter transfer function can be expressed as 
O(s) = bs?! +b s +b ns? (15) 
(sf +A )(s* +4) 
where A, =n/2+WVn” —4m/2 (i=1,2). In consequence 
L d dd 
S = (-30-5 n Am] 

(16) 


Hence, the poles will be negative for any n>0 and any p >0 satisfying the condition f = 
(2k + 1)(2p + 1) with p > k (p EN,k E N,) been consistent with the condition given in (13). 


Remark 1: The solution of the fractional-order differential equation (14) given by 


bE, | At?) + b tE g2 Al?) 


A, 
Le 
+b,tE; (4%) + bt Es y. (412) | 


0021 


+btP Es pa (At) |+ 





A | Ep, Art?) 


is obtained from the anti-transformation of O(s), that is 


A bs? '+b,s?? +bhns" 





L O) =L Cz- Gi) 
R A, bs?” a ÓN E 
A-A (s +4) 


where the continuous Laplace anti-transformation of Mittag-Leffler function by 
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p-n 
| mis _ Bmt- pm) y 8 
E (A El at” ) (17) 


was used. Since lim £}, (—atf)=0 then g(t) tends to the origin as t>00. 
t—> 0 g 


B. Existence of Sliding Modes 


The conditions for the trajectories to converge to the manifold S(q) = 0 and the sliding manifold to 
exists on this manifold may be derived based on the Lyapunov function [25] 


y-lg (18) 
2 


whose time derivative along the solution of the closed-loop system (9), (12) is given by 
V = SS =S(D“g(0) +nD q(t) + ma (A) 
= S(D 4A) + nD’ q(t) + mq). 
Substituting the right-hand side of (9) and the control input (12) into the last equation we get 


2-0 
2 


V = s|o= (=D g—mD'“g— pI ° sign(S) + eno z 


= s| -nD qm — pdt ° A] 


S|-pD“"I ° sign(S) + Dw] 


Since 4—1—Ó6 and a—1l are negatives, the following holds (cf. [21, p. 88]) 


rap |-p sign(.S) + D*w|S 
(19) 
<-D* | p -D° [|s]. 


Comment: D°w(t) is the fractional derivative of external disturbance which is uniformly bounded by a 
constant W. 


Therefore, V proofs to be negative definite for any p satisfying 
[D°w <W <p (20) 


where W, is a strict positive constant fixed a priori. 


C. Finite-Time Reachability 
Let us take the last inequality (20) 


— <-D*"*[p-W]|S|. (21) 


From (19) we have |S | =42V , then the last inequality can be rewritten as 


AS [o-W VF (22) 
By rewriting last equation as 
Elan [Ja (23) 


and integrating from 0 to £, it follows that 
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-2,/V (0) <-J2(p-W,)-D*** (1). (24) 
By using definition (6) we have 


= (0) V-W) P (25) 


2+8-a T(2+d-a) 
Finally, the estimated time that trajectories reach the sliding surface is given by 


(2+5-a) 
, _{2(2+8-a)r2+6—-a)V (0) | 
/ V2(p-W,) 


(26) 


II. EXPERIMENTAL STUDY 


Performance issues of the fractional order sliding mode controller were tested numerically and 
experimentally on a DC motor with friction (see Fig. 1). For the experiments we used the test-bed installed 
in the robotics and control laboratory of CITEDI-IPN which involves a DC motor manufactured by 
LEADSHINE, capable to handle high-switching frequency, and the SPACE control board DS1103. 


The controller was implemented using SIMULINK 2007 from MathWorks running on a personal 
computer with AMD A4-3400, 2.70 GHz, 2 GB processor. The resolution of the encoder is 1000 
counts/rev. The amplifier of the motor accepts a control input from the D/A converter in the range of + 10 
V. The sampling time was 10” s. 


Figure 1. Experimental testbench. 


— 


Servo-amplifier z da 


i 


A ADVANI 





The DC motor is governed by the following differential equation 


Jä + f,q + f. sign(q) =T (27) 


where q(t) € R is the angular velocity of the motor shaft, t(t) is the control input, J = 3.21x10° Kgm? is 
the inertia of the motor shaft, f, = 1.35x10° Nms-rad” is the coefficient of viscous friction, and f. = 6.8x10' 
? Nm is the coefficient of Coulomb friction. Therefore, the implemented control input was 


P=JU (28) 


where u(t) € R is given in (12). The gain and parameter of the fractional order sliding mode controller 
were set to m = 2, n = 8, p = 0.1, a = 0.78, B = 0.39, and ò = 0.2. These gains were chosen ad-hoc for 
avoiding the resonance frequency in the motor. 


A. Experimental Results 


To implement fractional order sliding mode control the fractional-order operators are approximated by 
an integer order transfer functions. Let [®,, @p]| be the frequency range of interest, then the approximation 
of the frequency-band fractional-order operators can be determined as follows [27]: 


å y a 
oO oO 
s? = (2) [| —~ (29) 
My) k=-Ny 4? 
0, 
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with 


k+N+4(1-A) k+N+}(1+4) 


where œ; is the zero of rank k, œ; is the pole of rank k and w, =./0,0. Here, wp < wy and wp > wp 
are the low-transitional and high-transitional frequencies, respectively. 


Figure 2. Numerical joint position and control input for the disturbance-free closed-loop system 
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Figure 3. Phase portrait of the closed-loop system (28), (29). 
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20 


04 


Time js! 


For the switching frequency of the DC motor, given by the manufacturer, the required transitional 
frequencies for the approximation of the fractional-order operators are set to œ = 2 rad s” and œ, = 2x10° 
rad-s'. Figure 2(a) shows the response of the DC motor, under arbitrary initial condition g(0) = 1 rad and 
g(0) = 0 rad:s”, where it is corroborated that the joint position reaches the origin asymptotically. Figure 
2(b) also illustrates the behavior of the control input where the switching frequency is less than the 
resonance frequency thus minimizing its undesired effect in the actuator like the overheating of 
components. Figure 3 depicts the phase-portrait of the closed-loop system. This figure shows that the 
trajectory reaches the sliding surface at finite-time t= 1.33 seconds satisfying the estimated reachability 
time given by inequality (27), that is, t< 67.44 seconds. 

Fig. 4(a) shows the response of the closed-loop system affected by an external bounded perturbation 
w(t)=0.05sin(27ft). Notice that the joint position follows the reference trajectory in spite of the presence of 
external disturbance. Figure 4(b) also shows the control input. 


Figure 5 illustrates comparative control inputs responses of the closed-loop system using fractional- 
order sliding surface (13) versus a conventional sliding mode control, that is, u = —mq + psign(S) with 
S=q+50q and p>W*, where w(t) is an external disturbance which is uniformly bounded by a 


constant W~ > 0, fixed a priori. 


Figure 4. Experimental FOSMC responses of the DC motor under external disturbance. 


(3) 
A a) a 




















q [rad] 
pa 





118 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 11, páginas 111 - 120. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


(01 








Gontrol input fv] 











EU 
Tinta [5] 


Notice that frequency of chattering of first order sliding mode control is higher than the chattering 
frequency of fractional-order sliding mode control. Therefore with a fractional-order sliding surface the 
effects caused by chattering can be minimized also preserving the finite-time reachability and robustness 
properties against external perturbations with bounded fractional derivative. 


IV. FUTURE WORKS 


We addressed the synthesis and analysis of a fractional-order sliding mode control for a perturbed 
double integrator. Robustness against external disturbances with a priori known norm bounds and finite- 
time reachability were analytically verified thus demonstrating that well-known properties of sliding 
mode controllers are preserved. Numerical and experimental results corroborate the effectiveness of the 
proposed control strategy. The resulting controller reduces the frequency of chattering, ensuring to be less 
than the resonant frequency. In addition, matched disturbances rejection and finite-time reachability to the 
sliding manifold is demonstrated in spite of the presence of Coulomb and viscous friction. Some tools for 
numerical implementation of fractional-order differential equations were also provided. Analytical 
verification of chattering attenuation via frequency domain methods still in progress. 


Figure 5. Comparative responses of the control inputs of the closed-loop system using (a) fractional-order sliding surface versus 
(b) integer-order sliding surface (S =ġ+cq, c> 0). 
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Micro algoritmos genéticos en arquitecturas de sistemas embebidos 
para la autonomía de marcha en robots 


F. A. Chávez Estrada, J. C. Herrera Lozada, J. Sandoval Gutiérrez y M. I. Cervantes Valencia 


Resumen— Los algoritmos genéticos (AG) aplicados en los sistemas de control han sido utilizados para incrementar la 
confiabilidad y desempeño de los procesos en la ingeniería; sin embargo el alto costo computacional y tiempo de ejecución 
requerido para dotar de autonomía la marcha de un sistema robótico con recursos limitados, ha representado un problema que no 
resuelven estos AG que solo llegan a la simulación. En este sentido para buscar dar una solución se ha utilizado un micro algoritmo 
genético (uAG) con un número reducido de individuos después de realizar experimentos comparativos con el AG. Utilizar un HAG 
permite encontrar en un menor tiempo las soluciones y genera una marcha autónoma sobre un robot diseñado con una 
arquitectura multicore de bajo consumo de energía, tamaño y peso reducido. Los resultados no se quedan en el análisis de una 
simulación se ha implementado en un sistema embebido (SE) por tanto se presenta el resultado utilizando JAG como un tipo de 
solución para ayudar en la autonomía de un robot y en aplicaciones como en la exploración de zonas hostiles y de riesgo para el ser 
humano e incluso en los robots manipuladores. 


I. INTRODUCCIÓN 


Los AG de acuerdo a con Araujo [1] al igual que otros algoritmos evolutivos son poblacionales. 
Generan una población de soluciones selecciona las mejores soluciones de acuerdo a la función fitness, 
remplaza la población original generando nuevas soluciones de mejores características como menciona 
Holland [2]. De esta manera las soluciones robustas se propagan de generación en generación de acuerdo 
a Golberg [3] tal como se muestra en la figural. 


Figural. Ciclo de un AG 





Solución 


En las últimas décadas los investigadores han desarrollado un interés particular en los AG para 
aplicarlos en resolver diversos problemas duros y encontrar con ellos soluciones a los diversos problemas 
para las diferentes áreas de las ciencias e ingeniería. A continuación se citan algunas investigaciones 
relacionadas: Gary Parker muestra en su investigación [4], un AG Cíclico que mejora la marcha de un 
robot cuadrúpedo muestra simulaciones e indica que se ha probado en un robot particular sin mencionar 
más información de su implementación y de los recursos de cómputo que utiliza. El AG de Chernova [5] 
es más robusto en los parámetros de evaluación y evita la convergencia prematura mejorando la marcha 
un 20% del robot AIBO. Gumiel en su investigación [6] se enfoca a estas técnicas evolutivas para 
mejorar el desempeño del mismo robot. Suzuki y Nishi en su artículo [7] aplican un AG en el robot para 
mejorar la trayectoria de las patas al dirigir eficientemente la fuerza aplicada e imitar la marcha de un 
perro. El robot AIBO se ha dejado de fabricar a partir del 2006 el cuál permitía realizar ensayos. La 
característica primordial de las investigaciones anteriores corresponden a que el robot tiene 16 grados de 
libertad (GDL). Por otra parte en los robots los manipuladores que tienen menos GDL se aplican las 
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técnicas evolutivas, Gonzalez, Vaca y Peña resuelven la cinemática inversa de un robot manipulador 
serial de 4 GDL aplicando un AG a partir del modelo cinemático directo screws [8] en un ambiente 
simulado. Estas técnicas se destacan por su amplia gama de aplicación son robustas se aplican cuando no 
existen técnicas especializadas no requieren conocimiento del problema y mejoran las técnicas 
tradicionales. A diferencia de lo anterior el trabajo muestra una investigación en el desempeño de los 
diferentes AG para la optimización de marcha en robots como es el caso de Chaohong y Hong en sus 
investigaciones [9] abordan la optimización de marcha con cuatro diferentes AG y solo compara las 
soluciones encontradas por estos métodos evaluando la velocidad, estabilidad y flexibilidad, mostrando 
resultados hasta la simulación. Considerando las fortalezas de estos algoritmos se decide utilizar como 
base un AG y se toma de referencia los AG como expone Herrera-Lozada en su investigación [10]. Las 
características que muestran los uAG con poblaciones menores a una decena de individuos encuentran las 
soluciones de los sistemas utilizando algoritmos genéticos. La implementación de ello en sistemas 
embebidos focaliza el interés de la presente investigación diseñar micro algoritmos aplicables a la 
autonomía de marcha en robots que se ejecuten en un SE y no en una computadora. Desarrollar un robot 
prototipo que beneficie al usuario en realizar investigaciones de marcha o aplicarlo en la exploración en 
zonas de riesgo para el ser humano y particularmente aplicar los uAG para resolver problemas como 
determinar la posición final de: brazos manipuladores [8], robots bipedos [11] [12], cuadrúpedos [9] y 
hexápodos [13]. 


El artículo se ha organizado como se indica: I Introducción, II Marcha de robots, HI Algoritmos 
genéticos, IV El micro algoritmo genético (MAG), V Implementación en el SE, VI Resultados y 
discusión, VII Conclusiones. 


Il. MARCHA DE ROBOTS 


Para desarrollar la solución de la marcha del robot se realizó el análisis de la cinemática tipo mamífero 
con la finalidad de considerar las características posibles en el diseño del algoritmo y en el diseño de la 
plataforma de un robot experimental. 


A. Tipo de marcha 


La locomoción de los robots con cuatro patas imitan el modo de caminar de los animales como indica 
Elijah [14], la imitación es de dos tipos: 

En el tipo reptil, el cuerpo es más próximo al terreno, su estabilidad es mayor, el consumo de energía es 
mayor al mamífero por el peso del robot, los torques en las articulaciones son mayores al mamífero y el 
desplazamiento es menor. 

En el tipo mamífero, el cuerpo es más alto por tanto el PDA es más estrecho y el centro de gravedad es 
más alto, la estabilidad del robot es menor y el consumo de energía depende de la cantidad de eslabones 
habilitados al mismo tiempo. Se elige esta locomoción para el desarrollo del prototipo con el patrón de 
mantener dos patas en el suelo y dos patas desplazándose a esto se le denomina trote. En la figura 2 se 
muestra el patrón de marcha. 


Figura 2. Diagramas de fase para el Trote 





Pata en el suelo 
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B. Estructura del robot 


En la segunda etapa, se ha diseñado y fabricado la estructura para que el robot pueda caminar como un 
mamífero y reptil. El diseño de cada una de las piezas se hizo en Solid Works y se fabricaron en una 
impresora 3D. La figura 3, presenta una vista superior del robot diseñado y las características de la 


estructura. 
Figura 3. Estructura del robot prototipo 
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La estructura básica de diseñado que se presenta en la investigación la constituyen el cuerpo y cuatro 
patas cada pata tiene tres eslabones. Los eslabones se encuentran unidos a los servomotores como se 
muestra en la figura 3b. El cuerpo es una plataforma rectangular que permite la instalación de las cuatro 
patas y los dispositivos electrónicos requeridos para el control. Las patas están dispuestas 
simétricamente en cada esquina para localizar el CDG dentro del PDA y lograr que los esfuerzos 
realizados por cada pata se distribuyan uniformemente y así controlar el consumo de corriente. 


C. Cinemática del sistema 


La tercera etapa consistió en determinar los movimientos angulares de los servomotores que están 
limitados por la estructura mecánica y forma de los eslabones. El rango de movilidad permite determinar 
la longitud de desplazamiento la altura máxima y mínima del paso del robot en una superficie 
horizontal. La altura de paso determina la altura máxima de los objetos que el robot podrá superar en un 
paso normal. Estos ángulos permiten una diversidad de configuraciones que puede adoptar el robot en la 
locomoción (movimientos restringidos y no restringidos). Se requiere convertir los desplazamientos 
angulares de los servomotores a desplazamientos lineales del robot. El análisis cinemático del robot es a 
través de matrices de transformación homogénea que describen los movimientos así como la geometría 
espacial, la rotación y traslación de robots con patas. La matriz de transformación homogénea modifica 
a un vector de posición descrito en coordenadas homogéneas de un sistema de coordenadas de referencia 
a otro sistema de coordenadas como describe Vukobratovic y Kircanski [15]. La matriz de 
transformación homogénea contiene cuatro sub matrices: 


T= | R3x3 Matriz de rotación Pz, Vector de posición (1) 
hix3 Transformación de perspectiva 1x1 Escalonado 


La sub matriz superior izquierda indica la rotación del sistema; la sub matriz superior derecha indica el 
vector de posición del origen del sistema de coordenadas rotado con respecto al sistema de referencia; la 
sub matriz inferior izquierda indica la transformación de perspectiva y el cuarto elemento diagonal es el 
factor de escala global. En aplicaciones de robótica, este factor de escala es igual a 1. Se determina la 
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matriz homogénea $T para cada articulación lo que indica la localización del i-ésimo sistema de 
coordenadas de cada articulación con respecto al sistema de coordenadas de referencia y está 
determinado por la ecuación (2). 

OT = | | A, (2) 


Al obtener la cinemática de una pata del robot permite encontrar la posición y dirección final de la punta 
de la pata al caminar a partir de los ángulos de cada articulación de la pata 01, 02 y 83 como se muestra 
en la figura 4a y 4b. 


Figura 4. Relación de ángulos de las una patas del robot 
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La matriz de transformación ĈT obtiene dichos puntos p; y es una función de sus coordenadas 
homogéneas con i articulaciones con respecto al sistema de referencia establecido para la pata con la 
ecuación (3) se obtiene dicho punto po. 


Do = “Tp; (3) 
Una pata tiene 3 GDL por tanto la ecuación (4) tiene 3 matrices de transformación homogéneas donde: 
TS TAAA (4) 


Se realiza la multiplicación de matrices en el orden que se indica dado que el producto de matrices no es 
conmutativo. 

Se utiliza el método Denavit y Hartenberg para determinar la geometria espacial de los elementos de la 
cadena cinemática (patas del robot) con respecto a un sistema de referencia (centro del robot). 

En una cuarta etapa una vez que se tiene la matriz de transformación y se muestra matemáticamente que 
el desplazamiento del robot lo determinan los valores de los ángulos 04, 0, ..0; de las articulaciones de 
las patas, se concluye que el AG será quien determine el valor de estos ángulos. En las etapas siguientes 
se describe a detalle la etapa cinco al aplicar un AG para la marcha autónoma donde se obtiene las 
características y restricciones de dicho algoritmo y en la etapa seis, se toma de base la etapa anterior 
para un nuevo diseño implementación y pruebas del uAG para la marcha autónoma. 


II. ALGORITMOS GENÉTICOS 


Los AG son procedimientos de búsqueda poblacional se basan en la teoría de la evolución de Darwin, en 
donde de forma natural se selecciona a los cromosomas o individuos de mejores características genéticas 
y son soluciones al sistema como describe Arraz y Parra en [16]. Este concepto se aplica en el desarrollo 
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del AG el cual resuelve problemas con los individuos que encuentra sin tener conocimiento del 
problema que resuelve. Los pasos del método son: 
e Se genera y evalúa la población aleatoria resultado de una función fitness. 
e Selecciona y permite la reproducción de las mejores soluciones (cromosomas). 
e Se genera una nueva población con hijos de mejores características como resultado de la optimización de 
la función fitness, de la cruza, mutación y elitismo. Siempre seleccionando las mejores soluciones o 
individuos. 


Estos pasos se repiten y con estas bases se diseña el AG el cual es el resultado de la función 
optimizada como exponen Oliveira y Santos [17] en su trabajo. El AG estándar desarrollado sigue el 
diagrama de flujo de la figura 5. 


Figura 5. Diagrama de flujo de implementación de un AG 





Con base en la figura 5, los pasos a desarrollar son: la codificación de las soluciones del problema en n 
cromosomas de longitud L y dada la función fitness o de evaluación proporcionar una medida de 
referencia para las soluciones que se van generando con el AG. En forma posterior se obtendrá una 
función resultado de comparar la función fitness con las soluciones encontradas y aplicarla al sistema 
para generar la marcha. 

De acuerdo con lo anterior se utiliza un AG simple para el problema de la marcha del robot con las 
siguientes características: 

Codificación del cromosoma: Con los ángulos de rotación de cada articulación se diseña el 
cromosoma. A cada ángulo se le asigna una cadena de un byte para cada pata se tienen 3 GDL. 
Obteniendo una cadena de 3 bytes para el cromosoma o individuo solución: 

Ángulos de las articulaciones de una pata: [0,, 0, , 03]. 

Las características del cromosoma es una cadena binaria: [01010101 01010101 01010101]. 

La función fitness del sistema son las soluciones o individuos en donde sus genes sean todos unos. 
(11111111 11111111 11111111]. 


125 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 12, páginas 121 - 132. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


Para lograr la condición anterior se define Las restricciones del sistema al elegir la locomoción tipo 
mamífero y se determina en cada articulación los ángulos máximos y el rango de los ángulos válidos 
[90°, 0° — 40°, 0° — 20°] como se muestra en la Tabla I. 


Tabla I. ÁNGULOS VÁLIDOS 


0-30 
Tobillo Posición fija Tobillo 
0-70 Posición fija 90 


La solución encontrada con el AG es decodificada cada byte corresponde al valor del ángulo de cada 
articulación. Estos valores se sustituyen en el vector de posición Ecuación 3 y se determina la posición 
de la punta de la pata en el espacio R? esta descripción se muestra en la figura 4c. 





IV. EL MICRO ALGORITMO GENÉTICO 


El uAG es una versión del AG estándar como ha sido descrito por Goldberg [3] tiene las mismas 
características descritas en la sección III. Tiene una población reducida de decenas de individuos incluso 
menos de una decena. 


Existe una área de investigación donde aplican AG para la Optimización Multiobjetivos en donde los 
algoritmos se paralelizan para las soluciones como expone Von Lucken, Hermosilla y Barán [18], sin 
embargo Herrera en su trabajo [10], utiliza uAG para resolver problemas debe asegurar que estos AG 
con una población reducida sean efectivos y eficientes. Lo anterior se logra modificando el AG estándar 
como muestra el diagrama de flujo de la figura 6. 
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Se agrega una convergencia nominal con un ciclo interno que permite encontrar las soluciones con una 
menor población y una convergencia general con un ciclo externo que permite generar diversidad en las 
soluciones debido a que el algoritmo se reinicializa después de i número de ciclos internos. 


V. IMPLEMENTACIÓN DEL SE 


En esta sección se muestran las configuraciones para implementar los algoritmos en el SE y que permita 
comparar los resultados del desempeño del AG estándar contra el uAG en la marcha del robot. 

El SE tiene una arquitectura de 8 cores con 32 puertos entrada/salida, memoria RAM de 32Kbytes, 
memoria de programa de 32Kbytes u un oscilador de 5 MHz. Tiene acceso directo a periféricos como un 
CAD, CDA y USB. Se utilizan 12 puertos para conectar en cada uno de ellos un servomecanismo y 
quedan disponibles 20 puertos del SE para sensores que se puedan requerir en un futuro. 

Se configura el computador con la Aplicación para programar el SE. Las aplicaciones se pueden 
descargar de la página del fabricante (www.parallax.com). Se utiliza la configuración para compilar en C 
se puede programar C++ o ensamblador. La información requerida para manejar el sistema embebido 
hardware y software se encuentra en la opción de ayuda de la App. 


Configurar la App del SE para compilar los algoritmos en lenguaje C. 


El robot cuadrúpedo prototipo se ha fabricado con una impresora 3D en material plástico ABS, con las 
siguientes características. 

Cada pata consta de 3 articulaciones con un servomecanismo por pata como resultado el robot tiene 12 
GDL. En cada articulación se tiene un servomecanismo figura 7. 


Figura 7. Robot cuadrúpedo y SE en el que se implementó el AG y HAG. 


== 3 
aw 





VI. RESULTADOS Y DISCUSION 


Se han probado y evaluado cuatro algoritmos con las caracteristicas reportadas en otros trabajos como 
los expuestos por Gumiel, Saenz y Quintana [6]. Los resultados obtenidos del AG en la presente 
investigación son similares a los que ellos obtienen de acuerdo a las tablas que se presentan. Excepto los 
resultados obtenidos en la investigación con el uAG 5x5 reporta un mejor desempeño con referencia a la 
media de la generación se incrementa al doble. 


A. Desarrollo y experimentos 


Los algoritmos deben cumplir las siguientes características: 
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Individuos de un byte. La función fitness es alcanzar el valor de 255. 
Población inicial de 16 individuos generados aleatoriamente. 
Generaciones que van de 10, 100 y 1000 unidades. 

Selección por elitismo de los dos mejores individuos. 

Un cruce en cada byte del individuo 


e Mutación de un bit en cada byte. 
El algoritmo debe indicar la generación y el tiempo en que encuentra la solución para la marcha. Se 
grafica el valor fitness del mejor individuo y la media de la generación del valor fitness de los 
individuos: 


1. Un AG estándar con 1000 generaciones. 

2. Un AG estándar de 100 generaciones. El AG estándar se ejecuta en el SE con 100 generaciones. 
3. Un AG con 10 generaciones. 

4. UnuAG 5x5 (5 ciclos externos X 5 ciclos internos= 25 generaciones). 

5 


Comparar el desempeño de los AG y el uAG para implementar cada uno de los algoritmos en el 
robot prototipo. El robot realiza la marcha y recorre una distancia de 0.9 m. Se mide el tiempo en 
que recorre dicha distancia. 


6. Se realiza la prueba en 10 ocasiones para cada algoritmo y se registran los tiempos medios en una 
tabla. 


B. Resultados 


1. El AG estándar con 1000 generaciones no se ejecuta en el SE. Se identifica que el algoritmo tiene un 
tamaño de 29 Kbytes y durante la ejecución se realizan dos poblaciones de 1000 individuos el resultado 
corresponde a rebasar la capacidad de memoria de programa del SE. Al reducir las poblaciones a 200 
individuos el algoritmo se puede ejecutar en el SE debido a que su tamaño se reduce a 26 Kbytes. 


2. El AG de 100 generaciones se ejecuta en el robot se muestran resultados en la figura 8. 


Figura 8. AG estándar 


AG estándar 
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Mejor Individuo ——=x— Media generación Objetivo 





Con estos datos el algoritmo encuentra las soluciones con una media de las generaciones de 100 
unidades. 


3. El AG con 10 generaciones encuentra la solución en la generación 4. La media de las generaciones 
es mayor al AG y tiene un valor de 130 unidades se muestra en la figura 9. 
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Figura 9. uAG estándar 
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El espacio en memoria del programa no es mayor a 24K bytes. El algoritmo programado tiene un ciclo 
interno de convergencia nominal de 5 iteraciones y un ciclo externo de convergencia general, en total 
este algoritmo ejecuta 5 generaciones en cada corrida y en promedio de dos corridas encuentra la 
solución del sistema. La media de las generaciones en los uAG es mayor respecto al AG. 


4. El AG 5x5 = 25 generaciones encuentra en menor tiempo y en menos generaciones las soluciones 
del sistema. El algoritmo contiene las mejores soluciones encontradas con el manejo de los operadores 
genéticos: elitismo de los dos mejores individuos y una doble mutación en las nuevas generaciones; 
estas características favorecen el desempeño del algoritmo para encontrar la solución, para este 
algoritmo la media de las generaciones se aproxima al 98% a la solución se muestra en la figura 10. 


Figura 10. AG 5x5 generaciones 
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5. Se realizaron pruebas al robot cuadrúpedo prototipo a diferentes velocidades (ver columna Velocidad 
(m/s)). Se determina el tiempo (ver en la columna Tiempo (s)) en que se desplazó una distancia de 90 
cm, se muestran resultados en la Tabla II. 
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Tabla II. TIEMPOS DE DESPLAZAMIENTO (a) pAG y (b) AG 


Comentarios 
(s) (m/s) 


0.073 
0.089 





Robot Mamifero distancia recorrida 90 cm con AG 


Tiempo Velocidad , 
Comentarios 
(s) (m/s) 
0.007 
80.9 0.007 











73.1 0.008 
65.3 0.009 










58.3 
47.9 
OY Valoróptimo | 


0.094 
0.095 Rápido riesgo al sistema 





Los avances obtenidos permitieron observar que el uAG tiene un mayor desempeño ya que en un menor 
tiempo encuentra las soluciones para la marcha del robot con respecto al AG y con estas condiciones la 
marcha del robot es continua. En este último experimento se ejecutan 10 veces los AG y el uAG 5x5 y en 
cada ejecución se obtienen los tiempos en que cada algoritmo encuentran las soluciones para y se 
muestran los tiempos en la Tabla III. 


Tabla IM. TIEMPOS DE EJECUCIÓN AG vs AG 5x5 
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En esta aplicación la función optimizada es una cadena de bits decodificada y almacenada en variables 
independientes. Cada variable proporciona la información en cada PWM determinando con ello el valor 
de la variable para el cálculo del ángulo máximo de la articulación que corresponde al ciclo de trabajo de 
la señal PWM para generar la marcha del robot. 


C. Discusión de Resultados 


En el trabajo se ha logrado una correcta implementación del AG con una poblaciones de 16 individuos 
y generaciones de 200 lo que permiten generar la marcha en un robot cuadrúpedo implementado en un 
SE. En la segunda etapa el uAG en el SE con una población máxima de 16 individuos y 10 generaciones 
se encuentra que el programa corre y genera una marcha continua en el robot. La característica 
primordial encontrada es que generan poblaciones reducidas y en el caso del uAG se identifica que una 
decena es suficiente para encontrar las soluciones de los sistemas. Trabajar estas características permite 
encontrar las soluciones válidas en un menor tiempo y genera un patrón de marcha. 
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VI. CONCLUSIONES 


En la presente investigación se genera un acercamiento para una correcta implementación del uAG en la 
plataforma diseñada: SE-robot cuadrúpedo prototipo. Además la plataforma puede auxiliar o contribuir 
para evaluar diversos AG de población reducida menores a 200 generaciones. Es la base para diseñar 
uAG lograr un aprendizaje Bio-inspirado que permita generar la marcha en un robot cuadrúpedo y se 
puede implementar a robots de mayor número de patas e incluso robots manipuladores. Una decena de 
cromosomas o individuos es suficiente para encontrar las soluciones de este tipo de sistemas estas 
características permite encontrar las soluciones válidas en un menor tiempo y generar un patrón de 
marcha. 

El presente trabajo también proporciona una guía de implementación de un AG o AG de población 
reducida en un SE; demanda menos recursos de procesamiento sin la necesidad de usar una 
computadora. Se puede someter a consideración como un prototipo educativo. Dotar a este tipo de 
sistemas de baterías y un SE les permite una mayor autonomía. 

Los AG son una alternativa para resolver problemas en donde los GDL crecen como es el caso de los 


robots con patas y robots manipuladores. Para estos sistemas el grado de complejidad aumenta al buscar 
soluciones tradicionales por medio de matrices además crece la demanda de recursos de cómputo. 


APLICACIONES 


Lo anterior permite mejorar la autonomía del robot y enfocar los robots en la aplicación de marcha con 
obstáculos así como marcha en regiones con diferentes superficies, exploración planetaria, agricultura, 
zonas de riesgos para el manejo de explosivos, zonas con ambientes peligrosos y contaminados, robots 
manipuladores aplicados a la industria, entre otros. 


AGRADECIMIENTOS 


Los autores agradecen a la Secretaría de Investigación y Posgrado del IPN por el soporte económico a 
través del Proyecto SIP 20160019 y al CONACyT por la beca para estudios de doctorado. 


REFERENCIAS 


[1] Araujo, L. "Algoritmos evolutivos: un enfoque práctico". Alfaomega. 2009. 


[2] Holland, J. H. "Adaptation in natural and artificial systems: an introductory analysis with applications to biology, control, and 
artificial intelligence". MIT press. 1992. 


[3] Goldberg, D. E. "Genetic Algorithms in search Optimization e Machine Learning". USA: Addison-Wesley Publishing Comapny Inc. 
1989. 


[4] Parker, G. B. “Using Cyclic Genetic Algorithms to Learn Gaits for an Actual Quadruped”. JEEE International Conference on 
systems. 2011. p1938--1943, DOI: 10.1109/ICSMC.2011.6083871. 


[5] Chernova, S. " An evolutionary approach to gait learning for four-legged robot". Intelligent Robots and Systems. Proceedings. 2004 
IEEE/RSJ International Conference. 2004. 2562--2567. vol 3. DOI: 10.1109/1RO5.2004.1389794. 


[6] Gumiel-Moreno Pablo, S.-A. Y.-M. "Implementación de técnicas de computación evolutiva a la programación automática de un 
robot". Madrid España: Universidad Carlos III de Madrid. 2009. Obtenido de http://hdl.handle.net/10016/6581 


[7] Suzuki, H." Animal Gait Generation for Quadrupedal Robot". Innovative Computing, Information and Control, 2007. ICICIC'07. 


131 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 12, páginas 121 - 132. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


Second International Conference on IEEE, 2007. DOI:10.1109/ICICIC.2007.169. 


Vaca-González J J, Peña-Caro C A y Vacca- Gonzalez H. "Cinemática inversa de robot serial utilizando algoritmo genético basado 
en MCDS". Tecnura, Bogota, 2015. Vol. 19(44), p.33-45. doi:dx.doi.org/10.14483/udistrital.jour.tecnura.2015.2.a02. 


Cai, C. "Performance Comparisons of Evolutionary Algorithms for Walking Gait Optimization". International Conference 
on(IEEE). 2013. p. 129-134.DOI: 10.1109/ISCC-C.2013.100. 


Herrera-Lozada JC. "Propuesta de una Metodología Generalizada para. CICOS 2009". Congreso Internacional de Cómputo en 
Optimización y Software, Memorias del 7mo Congreso de Cómputo CICO. 17-20 Noviembre 2009, UAEM, México, p.189-199. 


Dip, G. "Genetic algorithm-based optimal bipedal walking gait synthesis considering tradeo between stability margin and speed". 
Cambridge Univ Press(Robotica). Vol. 27/03, p. 355-365. DOI:10.1017/5026357470800475X. 


Barroso F, G. J. "Optimización Evolutiva de la Locomoción de un Robot Bípedo". Conference DRT4 ALL Universidad de Huelva 
España. 2011. Vol.1, p. 46-60. 


Gonzalez de Santos P, G. E. (2012). "Minimizing energy consuption in hexapod robots". Advanced Robotics. 2012. Vol. 23/6, p.681- 
704. DOI:10.1163/156855309X431677 


Elijah-McKenzie J. "Design of Robotic Quadruped legs". Massachusetts, USA: Massachusetts Institute of Technology. 2012. 
DOI:785729031-MIT 


Vukobratovic M and Kircanski. "Kinematics and Trajectory Synthesis of Manipulation Robots". Berlin Heidelberg: Springer- 
Verlag. 2013. DOI:10.1007/978-3-642-82 195-0 


Arraz de la Pefia, J. "Parallel Genetic Algorithm for Creation of Sort Algorithms". Springer Berlin Heidelberg, 8083(Computational 
Collective Intelligence. Technologies and Applications). 2013. p. 367-376. DOI:10.1007/978-3-642-40495-5 37. 


Oliveira M, S. C. "Multi-objective parameter CPG optimization for gait generation of a quadruped robot considering behavioral 
diversity". IEEE/RSJ International Conference on Intelligent Robots and Systems. 2011. p. 2286-2291. 
DOI:10.1109/1RO5.2011.6094819. 


Von Lucken, C. “Algoritmos Evolutivos para Optimización Multiobjetivo: un estudio comparativo en un ambiente paralelo 
asíncrono”. X Congreso Argentino de Ciencias de la Computación. 2004 


132 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 13, páginas 133 - 139. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


Sistema prototipo de adquisición de imágenes estereoscópicas 


J. A. Olvera-Balderas, J. C. Sosa-Savedra y M. A. Oloño García 


Resumen — Los sistemas de visión estereoscópica son aquellos que poseen características para la obtención de la información 
tridimensional de un ambiente. Existen diversas áreas de aplicación como sistemas para la navegación robótica, reconstrucción de 
objetos tridimensionales, manipulación de brazos robóticos, entre otras. En este trabajo se presenta el desarrollo de un sistema 
prototipo capaz de obtener un par de imágenes estereoscópicas con la ayuda de dos cámaras y empleando tecnología 
reconfigurable. Estas imágenes serán procesadas para obtener como producto final una imagen estereoscópica anáglifa. 


I. INTRODUCTION 


Gracias a la visión binocular, el ser humano posee la capacidad de ver el entorno en tres dimensiones, lo que significa 
poder visualizar dos imágenes con diferentes perspectivas, una para cada ojo. Este hecho presenta grandes ventajas, entre las 
que destacan: el captar la ubicación de objetos y la percepción de profundidad del entorno que nos rodea [1]. Por ejemplo: el 
ser humano utilizaba esta habilidad para cazar, conociendo perfectamente la distancia a la que se hallaba un animal, arrojaban 
sus lanzas contra él. 


La visión estereoscópica se encuentra basada en la visión binocular. Existen diversas técnicas de estereoscopía, pero en 
general, estas consisten en presentar imágenes para cada ojo con distintas perspectivas, con el fin de crear al sujeto una 
sensación de una tercera dimensión (3D) [2]. 


En la actualidad, la reproducción de imágenes se realiza a través de televisores, monitores de computadora, proyectores, 
dispositivos móviles, entre otros. Sin embargo, a diferencia de la visión binocular, la mayoría de estos dispositivos únicamente 
posee la capacidad de mostrar imágenes con una sola perspectiva, provocando la pérdida de aquella tercera dimensión. En la 
rama de la robótica, los robots tele-operados presentan grandes problemas al no tener un sistema de visión binocular [3]. No 
obstante, con los grandes avances tecnológicos se ha desarrollado por ejemplo televisores 3D, los cuales, implementan técnicas 
de visión estereoscópicas como la activa y polarización [4]. 


Un problema reciente es que esta tecnología tiene un alto costo de adquisición. La mayoría de los sistemas desarrollados en 
instituciones que tienen relación con la visión estereoscópica, emplean como elemento de ejecución a un computador de 
propósito general y son implementados en lenguajes de alto nivel como java [2] o .NET [5]; implicando una baja portabilidad 
del sistema. 


Por tal razón, en este trabajo se propone el desarrollo de un sistema embebido prototipo de visión estereoscópica, con las 
ventajas de ser de bajo costo y con una alta portabilidad. Para ello se empleará tecnología lógica reconfigurable y dos sensores 
de visión CMOS. Cada sensor tiene la capacidad de adquirir imágenes de 1.3 MP a 30 fps. 


II. ANÁLISIS DEL SISTEMA 


A. Descripción 


Se requiere de un sistema de visión que implemente la técnica de visualización estereoscópica anáglifa [2]. Este debe 
contar con la capacidad de obtener dos imágenes estereas simultáneamente, a través de dos cámaras, y con ellas lograr la 
reproducción de una imagen estereoscópica tipo anáglifo, la cual, será transmitida mediante el protocolo VGA a un monitor 
convencional, de esta forma, el usuario podrá visualizar la imagen con ayuda de unas gafas de filtro anaglifico. 


B. Técnica de visualización estereoscópica pasiva de anaglifo. 


La técnica de anáglifo a diferencia de la estereoscopia activa, requiere de unas gafas de bajo costo y de fácil acceso. Esta 
técnica se encuentra basada en el filtrado de las ondas de longitud de la luz visible. Pueden implementarse técnicas de filtrados 
de colores aditivos o sustractivo [6]. El monitor debe presentar ambas imágenes (la imagen con perspectiva del ojo izquierdo y 
la del derecho) superpuestas. Sin embargo, antes de ser superpuestas, en cada imagen se debe aplicar un filtrado de color ya sea 
aditivo o sustractivo. Cuando el monitor muestra ambas imágenes superpuestas, la luz que intenta pasar a través de cada lente 
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es filtrada, permitiendo el paso de sólo ciertas longitudes de onda (color), 1.e. permite separar nuevamente las imágenes 
superpuestas, lo que ayuda a entregar a cada ojo su imagen correspondiente. Por ejemplo, a la imagen del ojo izquierdo se le 
aplica un filtrado de color rojo (lo que significa que estamos eliminando sus colores verde y azul [6]), y a la imagen del ojo 
derecho se le aplica un filtro cian (lo que significa que estamos suprimiendo su color rojo [6]), después, son superpuestas y 
mostradas por el monitor. Supongamos que los lentes contienen un filtro rojo (lente izquierdo) y uno cian (lente derecho), a la 
hora en que la luz de la imagen intenta pasar por las gafas, el lente rojo sólo permitirá el paso de la imagen a la que se le aplico 
el filtro rojo, mientras que el otro lente solo permitirá el paso de la imagen derecha. Entregando así una imagen distinta a cada 
ojo, consiguiendo así una ilusión 3D. 


C. Hardware. 


Para la implementación hardware, las opciones VLSI (Very Large Scale Integration), ASIC (Application Specific 
Integrated Circuit) y PLD (Program Logic Device) proporcionan diseños hechos a la medida del sistema deseado y dan una 
gran velocidad de procesado, sin embargo, los diseños VLSI y ASIC no pueden ser reconfigurados y tiene un alto costo de 
fabricación, a diferencia del diseño con un PLD. Mientras tanto, un DSP (Digital Signal Processor) presenta una gran 
flexibilidad de programación, puede emplear lenguajes de alto nivel, sin embargo, al ser tan flexibles, la velocidad de ejecución 
de cualquier algoritmo computable es más lenta debido a que la arquitectura no está especializada para el algoritmo a ejecutar, 
otra desventaja es el costo de los mismos respecto a un diseño con un PLD. El punto intermedio, entre un chip hecho a la 
medida y un chip con una arquitectura ya estructurada, es el empleo de los dispositivos lógicos programables (PLD). 


Las ventajas que proporcionan son: 1) la arquitectura de estos puede ser adaptada al algoritmo que se desea implementar 
mediante un lenguaje descriptivo de hardware (HDL), 2) son muy eficientes al implementar algoritmos que pueden ser 
ejecutados de forma paralela, 3) son reconfigurables, 4) tienen una alta portabilidad [7]. Cabe mencionar que los lenguajes para 
descripción de hardware (HDL) más comunes son VHDL y Verilog [8]. 


Una implementación hardware proporciona una mayor velocidad de procesamiento que una implementación software. 
Dentro de las alternativas de una implementación hardware, los PLD son la alternativa más viable para la implementación de 
un sistema de visión [9]. 


Los PLD pueden ser clasificados en SPLD (Simple Programable Logic Device), CPLD (Complex Programable Logic 
Device) y FPGA (Field Program Gate Array). Los SPLD aun que son de bajo costo, presentan la desventaja de tener una baja 
cantidad de macro celdas, por lo tanto, no es posible implementar sistemas robustos; por otro lado, la tecnología de los CPLD y 
FPGA ha mejorado mucho últimamente, lo que permite implementar sistemas mucho más robustos que en un SPLD y a un 
bajo consumo eléctrico. Algunas de las aplicaciones más comunes que implementan CPLD son [10],[11]: sistemas para control 
de encendido, sistemas de configuración, expansiones de entrada/salida, interfaces de conexión, entre otras; en cuanto a los 
FPGA, son comúnmente utilizados en soluciones más robustas; por ejemplo, aplicaciones industriales [10]. De lo anterior se 
puede concluir que la mejor opción para implementar este proyecto es la tecnología FPGA. 


III. ARQUITECTURA DEL SISTEMA 


En la Figura 1 se puede apreciar la arquitectura del sistema en general. En las siguientes secciones se realizará la 
descripción de cada una de las etapas y módulos que componen el sistema. 
A. Cámaras 


En esta etapa se requiere del uso de dos cámaras, con la característica de que los sensores se encuentren físicamente 
separados por una distancia aproximada de 45mm a 75mm [2]. De acuerdo a la investigación realizada, las cámaras que serán 
utilizadas tendrán una separación de 35mm. 


B. Controlador de cámara 


El sistema debe tener la capacidad de configurar, sincronizar y controlar las dos cámaras conectadas a él, con el fin de 
obtener dos imágenes simultáneas. Para ello, se debe diseñar un “Controlador” o Driver; a continuación, los datos obtenidos 
por el controlador, son transmitidos al bloque “Reconstrucción de imágenes”. El driver debe encargarse de configurar las 
cámaras de modo que estas brinden imágenes en formato VGA (640(H) x 480(V) pixeles). 


Debido a las características de las cámaras, se requiere que éste módulo tenga la capacidad de comunicarse con la cámara a 
r . e, 2 
través del protocolo de comunicación IC. 


C. Reconstrucción de imágenes RAW a 320 x 240 pixeles RGB 


Este bloque tiene la función de interpretar los datos proporcionados por el controlador de la cámara. A partir de ello, 
reconstruirá la imagen capturada entregando a la salida imágenes con un tamaño de 320 x 240 pixeles en formato RGB. 
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D. Filtros anaglificos y superposición de imágenes estereoscópicas 

La técnica de visualización 3D tipo anáglifo requiere de dos filtrados diferentes (filtro rojo y cian en este caso), los cuales, 
son aplicados a la imagen correspondiente (imagen izquierda y derecha). Una vez aplicado el filtro, las imágenes deberán de 
ser superpuestas entre sí. 
E. Controlador SRAM 

El objetivo de éste módulo es poder almacenar en una memoria SRAM las imágenes estereoscópicas y a su vez, poder 
leerlas y entregarlas a la salida cuando el siguiente módulo lo requiera. 
F. Reconstructor de imágenes a 640 x 480 pixeles 

Éste módulo se encarga de redimensionar las imágenes de 320x240 pixeles (almacenadas en la SRAM) a imágenes de un 
tamaño de 640x480 pixeles. 
G. Controlador de salida VGA 

Este controlador es el encargado de transmitir la imagen final hacia el monitor. El formato de las imágenes que debe recibir 
es VGA (640(H) x 480(V) pixeles) con una resolución de 10 bits por color. 
H. Unidad de control 

Cada uno de estos bloques funcionales es controlado y sincronizado mediante la “Unidad de Control”. Está diseñada 
especialmente para este sistema. Las funciones que realiza en orden la unidad de control son los siguientes: 

1. Activar los controladores de ambas cámaras para comenzar la configuración de estas. 


2. Una vez terminada la configuración de ambas cámaras, se indica simultáneamente a los controladores de las cámaras 
que comiencen la recepción de imágenes; a la vez, son activados los bloques: reconstructor de imágenes RAW a RGB, 
controlador SRAM, reconstructor de imágenes a 640x480 pixeles y por último, el controlador VGA. 


No obstante, cada uno de los bloques tiene la capacidad para detectar el inicio y fin de una imagen, de esta forma al 
terminar de procesar los datos de una imagen, estos vuelven a su estado inicial para comenzar la recepción de la siguiente 
Imagen. 


I. Visualización de imágenes estereoscopicas tipo anaglifo 


Finalmente, un monitor se encontrará mostrando las imágenes proporcionadas por el sistema. Con la ayuda de unas gafas 
con filtro anáglifo (filtro rojo y cian), el usuario tendrá la capacidad de apreciar las imágenes en 3D. 


Controlador de cámara 
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Figura 1. Arquitectura del sistema de adquisición de imágenes estereoscópicas. 
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IV. HERRAMIENTAS UTILIZADAS 


A. Kit de desarrollo TRDB_DC2 


Cuenta con dos cámaras MT9MO11, las cuales contienen un sensor tipo CMOS de 1.3Mega pixeles. También cuenta con 
un conector de 40 pines, para realizar una conexión satisfactoria con los conectores de expansión integrados en las tarjetas de 
desarrollo DE2/DE1 y TREX-C1 a través de un cable IDE [12], [13]. 


B. Software 


Debido a las tecnologías seleccionadas para la implementación del sistema, el software de desarrollo utilizado fue “Quartus 
IT ® versión 13.01 Services Pack” de Altera. 


Reporte de compilación: En la tabla 1 se presenta el reporte general del código del sistema, donde puede observarse que se 
requirió menos de la mitad de recursos de la tarjeta de desarrollo para la implementación del sistema, aunque en cuanto a 
entradas y salidas físicas se requieren demasiados pines, que podría ser una desventaja en caso de tener un FPGA con menos 
entradas y salidas disponibles. 


Tabla 1. Resultados de compilación. 


Resultado 
Flow Status 


Quartus IT 64-Bit 13.0.1 Build 232 06/12/2013 SP 1 SJ 
Version Web Edition 


1,683 / 33,216 (5%) 


Total combinational 1,455/33,216(4%) 
functions 

Dedicated logic 1,023 / 33,216 (3% 
registers 


) 
1023 
Total pins |425/475(89%) 


Total memory bits 138,240 / 483,840 ( 29 % ) 


Embedded Multiplier 9- A 
bit elements Or TALO A) 


Total PLLs 0/4(0%) 





V. RESULTADOS Y CONCLUSIONES 


El inicio del sistema es controlado a través de la activación de un switch de la tarjeta de desarrollo. Una vez activado, la 
transmisión de las imágenes estereoscópicas se realiza instantáneamente. 

Se logró la adecuación del sistema para que entregue a la salida 30 fps, la mayor velocidad que se logró alcanzar para 
imágenes con una resolución de 640x480 pixeles, con una frecuencia de reloj de 25 MHz en el pin MCLK de las cámaras 
(Frecuencia máxima recomendada por el fabricante). 

Se realizó la toma de la figura de un caballo de yeso (Figura 2), a la que se le aplicó la estereoscopía anáglifa para la 
prueba del sistema. 
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Figura 2. Figura de caballo de yeso, forma original. 


En la Figura 3, se puede apreciar la imagen 3D final proporcionada por el sistema, en ella se pueden apreciar dos imágenes 
estereoscópicas superpuestas, una correspondiente al filtro rojo y otra al cian. 


ba 2 








A 1 = 
Figura 3. Imagen estereoscopica de tipo anaglifica del caballo de yeso. 


En las figuras 4 y 5 se muestran las imágenes estereoscópicas por separado. Cabe mencionar que para obtener estas 
Imágenes, se requiere bloquear completamente un sensor a la vez. 


tJ 


Figura 4. Imagen del caballo de yeso con filtro anaglifico Cian. 
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Figura 5. Imagen del caballo de yeso con filtro anaglifico Rojo. 


El procesamiento de estas imágenes y su apreciación en 3D requiere de unos lentes anáglifos (Figura 6), lo cual puede 
presentar algunos inconvenientes para el usuario. 





Figura 6. Lentes andglifos con filtro cian y rojo. 


A pesar de lograr la estereoscopía anaglífica, la capacidad de trabajo de los sensores, se está quedando corta en cuanto a 
procesamiento de imágenes hoy día que se manejan resoluciones superiores a los 5MP, aunque se puede mejorar la velocidad 
de fotogramas por segundo, esto no se puede probar a mayores resoluciones, aunque una mayor velocidad puede ayudar en 
trabajos de análisis de movimiento. 


Por otro lado, el uso de lentes anáglifos también está quedando obsoleto y se está remplazando por técnicas diferentes, ya 
que el anáglifo presenta dificultades para el usuario como lo son el poder enfocar la imagen en 3D, y algunas personas 
presentan un efecto de vista cansada a los pocos minutos de utilizar las gafas debido a los colores que el ojo percibe; 
presentando también la desventaja de que al ser imágenes en base a filtros de 2 colores, se pierden colores percibidos por el 
ojo humano. 


A trabajo futuro, existe la posibilidad de trabajar con resoluciones mayores para tener una mejor calidad de imagen, 
aunque por el hecho de que este tipo de procesamiento de imágenes 3D está quedando obsoleto, sería conveniente trabajar 
con el procesamiento 3D SBS (Side By Side). 
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Desarrollo de un sistema para comunicación utilizando EOG* 


Miguel I. Ceballos Pérez’, Eduardo Morales Sánchez! 


‘Centro de Investigación en Ciencia Aplicada y Tecnología Avanzada, Instituto Politécnico Nacional 


Resumen — En México hay casi medio millón de personas con limitación para hablar o comunicarse, entre las cuales algunas no 
pueden siquiera moverse. El propósito de este trabajo es presentar una alternativa que sea rápida, eficiente y sencilla, para que 
personas con limitación para hablar y moverse puedan comunicarse con otras personas de manera verbal. 

El sistema utiliza la actividad eléctrica generada por los músculos implicados en el parpadeo de los ojos, para la selección de 
frases de necesidad básica, el sistema está basado en un circuito integrado de Texas Instruments (ADS1299) y el software Labview, 
en este trabajo se presenta la metodología que utilizada para desarrollar este sistema. 


Palabras claves — Electroculografía, Adquisición de señales, actividad muscular 


I. INTRODUCCIÓN 


“El habla es natural para el ser humano pero también es parte de la necesidad social del ser humano expresado a través de 
las palabras” [1], sin embargo, hay enfermedades que disminuyen la capacidad de comunicación de las personas, al menos en 
México hay más de 477,000 personas con limitaciones para hablar o comunicarse [2]. Se han inventado técnicas y métodos 
para que estas personas logren comunicarse, como lenguaje de señas o dispositivos eléctricos para personas mudas, hay 
personas que tienen limitación para comunicarse y no logran controlar las partes de su cuerpo por completo. 


Los músculos que menos daños presentan son los músculos oculares, por lo que resulta atractivo utilizar el movimiento 
ocular para desarrollar tecnología que permita a personas con ciertos tipos de discapacidad a comunicarse con otras personas. 
Se han desarrollado diferentes sistemas de comunicación utilizando el movimiento ocular, sin embargo, una gran parte de 
estos se basa en imágenes, estos sistemas son muy precisos, pero necesitan de sistemas costosos y un alto procesamiento. 


El electrooculograma (EOG) es un método que puede detectar los movimientos oculares, el cual mide el potencial eléctrico 
entre la córnea (eléctricamente positiva) y la parte posterior del ojo (eléctricamente negativa), por esta razón es que el globo 
ocular se considera como un dipolo eléctrico, de este modo, el movimiento del globo ocular provoca cambios en la dirección 
del vector eléctrico del dipolo eléctrico. [3] 


Las mediciones electrooculográficas se realizan con el uso de amplificadores en modo diferencial; existen dos formas de 
medir una señal electrooculográfica, la primera es midiendo la actividad eléctrica de forma horizontal y la segunda es 
midiendo la actividad eléctrica de forma vertical, como se muestra en la Figura 1, aunque la principal razón de realizar un 
electrooculograma es registrar la actividad eléctrica del movimiento del ojo, el electrooculograma es capaz de medir la 
energía eléctrica producida por los músculos cuando se realiza un parpadeo o se cierra un ojo o los dos. 
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Figura 1 Diagrama de colocación de electrodos para EOG 
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Dado que es posible medir la actividad eléctrica del movimiento de los ojos o de los músculos implicados en el parpadeo o 
al cerrar los ojos de una forma relativamente sencilla, resulta atractivo desarrollar sistemas de comunicación para personas 
que no tienen un control absoluto de su cuerpo, ni del habla pero que aún tengan un gran control sobre sus ojos y los 
músculos implicados. Por ello se pensó en el desarrollo de un sistema de comunicación veloz que pueda ser controlado con el 
cierre y la apertura de los ojos. 


II. ADQUISICIÓN DE SEÑAL EOG 


La adquisición de señal bioeléctrica ocular se realizó con un circuito integrado (CI) ADS1299 desarrollado por Texas 
Instruments para mediciones bioeléctricas, dicho circuito adquiere la señal en tiempo real de 8 canales en modo diferencial a 
una velocidad de muestre desde 250 muestras por segundo (MpS), hasta 16 mil MpS, dichas señales son amplificadas, 
convertidas en señales digitales y entregadas por protocolo SPI. (Figura 2) 


A. Comunicación ADS1299 a microcontrolador 


Dado que la frecuencia entre la que oscila la señal eléctrica ocular es de 0.3 a 38 Hz [4], el CI ADS1299 puede trabajar a 
su velocidad más baja (250 Mp5), se utilizó un microcontrolador PIC 18F4550 esto debido a que cuenta con un módulo de 
SPL la frecuencia de trabajo es de hasta 48 MHz y cuenta con un módulo de USB 2.0, lo cual es suficiente para la aplicación. 
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Figura 2 Diagrama de bloques del circuito integrado ADS1299 


El PIC es el encargado de configurar el CI ADS1299, al cual se le debe especificar la ganancia de amplificación debido a 
que esta esta es programable, se debe ajustar el CI para que lea en modo diferencial, entre otros parámetros. Una vez que el 
CI se configura se adquiere la señal de 24 bits de los 8 diferentes canales. [5] 


B. Comunicación microcontrolador a PC 


Para realizar la comunicación entre el PIC y la PC se utilizó el software Labview y la capacidad del PIC de simular un 
puerto serial por el módulo USB. La señal que entrega el CI ADS1299 es enviada directamente a la PC en forma hexadecimal, 
sin realizar operaciones o algún procesamiento a esta señal, con la finalidad de que el PIC no llegue a perder datos de la señal. 


Una vez que la señal es adquirida por el software Labview cada medición de cada canal debe ser transformada ya que esta 
se encuentra en complementos a 2, para lo cual, primero se debe convertir el valor a 32 bits ya que no existen variables de 24 
bits, para esto se lee el bit 23, si éste es un 1 los espacios del 24 al 32 se completan con 1, posteriormente a la variable se le 
resta 1 y se niega todo el valor y se multiplica por -1, en el caso que el bit 23 sea 0, el valor corresponde sin necesidad de 
realizar alguna operación. (Figura 3) 


141 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 14, páginas 140 - 146. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 





Figura 3 Complementos a 2 para 1 canal 


C. Colocación de electrodos 


Los electrodos se colocaron en forma vertical en ambos ojos (Figura 4) con la finalidad de registrar la actividad eléctrica 
de cada ojo y poder distinguir cuando se cierra un ojo u otro. 





Figura 4 Posición de electrodos 


Una vez que la señal es obtenida del PIC y transformada de complementos a dos se grafica en el tiempo para poder 
visualizarla (Figura 5), sin embargo, esta señal no es fácil de apreciar ni de interpretar debido a que es necesario 
acondicionarla, ya que la señal tiene ruido del ambiente que entra al cuerpo debido a que este actúa como una antena a 
cualquier señal, tal es el caso de la señal de la red eléctrica (60 Hz). 
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Figura 5 Señal en tiempo real 


III. ACONDICIONAMIENTO Y PROCESAMIENTO DE SEÑAL 


A. Acondicionamiento de señal 


Dado que el cuerpo humano funciona como una antena para toda señal en el ambiente es necesario aplicar filtros a la señal 
para acorar el rango de frecuencias que se encuentran en la señal, así como eliminar las frecuencias conocida como la de la 
red eléctrica (60 Hz). 


Los rangos de frecuencia en los que oscila la señal eléctrica ocular se encuentra entre 0.3 a 38 Hz, sin embargo, para esta 
aplicación solamente es necesaria la señal correspondiente al parpadeo la cual se encuentra entre 1 y 3 Hz. 
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Para facilitar el procesamiento de la señal y dado que la señal del parpadeo se encuentra entre 1 y 3 Hz se aplicaron filtros 
a la señal en tiempo real, se aplicó un filtro mata-bandas a 60 Hz y un filtro pasa-banda de 1 a 20 Hz. (Figura 6) 





Figura 6 Filtros para acondicionar la señal 


La señal que se obtiene después de realizar el acondicionamiento de la señal se puede ver en la Figura 7, en dicha figura se 
puede apreciar la actividad eléctrica del músculo ocular correspondiente al parpadeo, se pueden observar dos señales muy 
parecidas, esto debido a que se encuentran en ellas las señales correspondiente a la actividad eléctrica de ambos ojos. 
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Figura 7 Señal acondicionada mostrando la actividad eléctrica del parpadeo 
B. Procesamiento de señal 


Se puede ver en la señal eléctrica del parpadeo que tiene una forma muy peculiar la cual es idéntica en cada parpadeo, al 
realizar una transformada rápida de Fourier se puede apreciar una frecuencia pico entre 1 y 3 Hz la cual corresponde a la 
señal del parpadeo (Figura 8). 





Amplitude 








Figura 8 Transformada Rápida de Fourier de la Figura 7 


Para poder realizar la Transformada Rápida de Fourier se tuvo que discretizar la señal en 1 segundo y medio por lo que 
cada señal de control de los parpadeos se realiza cada segundo y medio. 


Dado que una Transformada Rápida de Fourier entrega una frecuencia pico entre 1 y 3 Hz cuando hay un parpadeo se 
utilizó esta técnica. A la señal de ambos ojos se aplicó tanto el acondicionamiento, como la transformada de Fourier. 


Cuando se cierra y abre un solo ojo se puede observar en la gráfica de la señal de ambos ojos que ambas señales presentan 
un comportamiento similar, esto debido a que aunque sea pequeño en el ojo que no se cierra y abre existe un movimiento 
muscular el cual es detectado por el electrooculograma, cuando se analiza la señal, se puede apreciar que hay una señal que es 
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más pequeña y otra que es más grande, lo cual se puede ver reflejado en el espectro de frecuencia (Figura 9), esto nos indica 
que se realizó un parpadeo con un ojo. 
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Figura 9 Parpadeo del ojo derecho 


Dado que el espectro de frecuencia entrega una amplitud más grande en el espectro que corresponde al ojo con el que se 
parpadeo se decidió tomar esto como característica clave para poder clasificar entre el ojo derecho o el izquierdo. 


Para realizar la clasificación, primeramente se analiza en el espectro de frecuencia de ambas señales, cual la frecuencia que 
tiene una amplitud mayor, si la frecuencia con mayor amplitud es entre 1.5 y 3 Hz en ambos espectros de frecuencia (ojos 
derecho y ojo izquierdo), el sistema supone que el usuario parpadeó o cerró y abrió un ojo, en caso contrario el sistema no 
actúa, cuando se detecta parpadeo o cierre y apertura del ojo, se comparan los valores de amplitud de la frecuencia con 
amplitud máxima, si la diferencia entre los valores es menor al 5% respecto al valor máximo el sistema considera que es un 
parpadeo normal, con ambos ojos y no se realiza acción de control, en caso que la diferencia sea mayor al 5% el sistema 
supone que un ojo se cerró y abrió y toma el que tuvo un valor máximo como verdadero. 


En la Figura 9 el valor máximo de amplitud se encuentra en 2.5 Hz en el ojo izquierdo y en 2 Hz en el ojo derecho, por lo 
que el sistema considera que hubo un parpadeo, al comparar los valores picos, se encuentra que el ojo derecho tiene una 
amplitud mayor por lo que el sistema toma como cierre y apertura del ojo derecho. 


IV. INTERFAZ PARA COMUNICACIÓN 


Una vez que se logró clasificar las señales y que se comprobó que el sistema detecta y clasifica correctamente las señales, 
se desarrolló una interfaz para comunicación Hombre-Máquina, la interfaz se puede apreciar en la Figura 10, en la cual se 
tiene una barra central con números del 1 al 5, en esta el usuario puede rotar los números cerrando y abriendo los ojos para 
hacer que el número que quiere quede dentro del cuadro verde, estos números están relacionados con una frase las cuales se 
muestran en la parte inferior, una vez que el número que el usuario desea seleccionar se encuentra en el cuadro verde, la 
forma de seleccionar la frase se realiza con un botón el cual se puede colocar en cualquier sitio dependiendo de la movilidad 
del usuario; una vez que usuario selecciona un número, la frase relacionada a ese número se reproduce por las bocinas de la 
computadora y el sistema sigue trabajando de forma normal a la espera de otra señal de control. 
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T =- Quero ir a! baño 
2 = Tengo hambre 
3 = Necesito ayuda 
4 = Tengo sed 

5 = Hola 





Figura 10 Interfaz Hombre-Maquina 


El sistema se probó con un usuario al que se le colocaron los electrodos como se muestra en la Figura 4 y se probó, se le 
pidió que seleccionara diferentes frases. 





Figura 11 Colocación de los electrodos 


Las pruebas realizadas mostraron un desempeño aceptable y un sistema muy sencillo de utilizar, sin embargo, se encontró 
que cuando se realizan movimientos rápidos del cuerpo o rotación de los ojos el sistema no logra identificar si se trata de un 


parpadeo o no. 


V. CONCLUSION 


Los resultado obtenidos, muestran un comportamiento aceptable ya que el sistema trabaja correctamente, con una 
velocidad de respuesta buena y suficiente para la aplicación, la solución al problema propuesta en este artículo, resulta muy 
interesante para el uso en personas con limitaciones para moverse y hablar, tal es el caso de personas tetrapléjicas que tienen 
un control muy limitado de su cuerpo. 


Aunque el sistema es muy fácil de usar y una solución interesante, no resulta muy práctico al utilizar los electrodos, esto 
debido a que se pueden despegar después de un cierto tiempo y no se recomiendan para usarlos más de una vez, sin embargo 
se podría evaluar el uso de electrodos secos colocados en unas gafas, lo cual haría al sistema más práctico de usar, así como 


más cómodo. 
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Diseño de un robot móvil para desplazamiento en terreno agreste* 


J. Alejandro Aguirre Anaya, O. Octavio Gutiérrez Frías 


Resumen— El presente trabajo aborda el diseño de un robot móvil de tipo ruedas caminantes con sistema de suspensión pasiva 
en forma de paralelogramo con la capacidad de transitar sobre terreno poco estructurado, describiendo las características de la 
estructura mecánica, la instrumentación electrónica y la estrategia de control implementada en el sistema. 


I. INTRODUCCIÓN 


Un robot móvil requiere mecanismos que le permitan desplazarse sobre su entorno para realizar una determinada tarea o 
misión. En particular para solucionar el problema de movilidad sobre terreno agreste o poco estructurado, se propone el uso de 
patas ya que ofrecen la mejor maniobrabilidad con respecto a otro tipo de locomoción, sin embargo en terrenos planos son 
poco eficaces y requieren de un control sofisticado [1], por otra parte, se tienen los robots que se desplazan por medio de 
ruedas los cuales son eficientes en terreno plano pero no en terreno irregular, partiendo de esto, se tiene la alternativa de 
combinar la adaptabilidad de las patas con la eficiencia de las ruedas, y éstos se denominan robots móviles de tipo ruedas 
caminantes [1], existen dos tipos de robots de acuerdo a la complejidad del sistema de suspensión que utilicen: Los de 
suspensión activa y los de suspensión pasiva [2]. 


En el caso de los robots móviles de suspensión activa, se utilizan actuadores para modificar su centro de gravedad con la 
finalidad de mejorar su capacidad de superar obstáculos y su capacidad de adaptarse al terreno. En [3] se describe el robot 
SCARAB el cual emplea una articulación activa en los laterales para reconfigurar el sistema de suspensión. En [4] se presenta 
el robot denominado Octopus desarrollado por el Instituto Federal de Tecnología Suizo, el cual está formado por mecanismos 
en forma de paralelogramo con motores como actuadores, los cuales modifican el centro de gravedad de acuerdo al terreno 
donde transita, otros trabajos interesantes donde se aborda este tema se pueden encontrar en [5-7]. 


Por otra parte, los móviles de suspensión pasiva no tienen actuadores para modificar su centro de gravedad, el sistema de 
suspensión cambia dependiendo de la forma del terreno por la acción del mecanismo debido al peso, por tal motivo, requieren 
de pocos sensores y actuadores permitiendo que se tenga un consumo energético menor. Por ejemplo en [8] se describe el 
robot móvil Sojourner, que utiliza una suspensión llamada Rocker Bogie en los laterales con un sistema de tracción de seis 
ruedas independientes y cuatro motores para la dirección. En [9] se muestra un dispositivo que cuenta con 3 sistemas de 
suspensión independiente que tienen dos ruedas con tracción en cada uno de ellos denominado RCL-E. Además, en [10] los 
autores presentan el robot SOLERO el cual tiene una rueda en la parte frontal, una rueda en la parte posterior y dos sistemas 
de suspensión en cada lado cuya arquitectura es en forma de paralelogramo, otros ejemplos pueden encontrarse en [11-13]. 


El presente trabajo aborda el desarrollo de un robot móvil de tipo ruedas caminantes con sistema de suspensión pasiva, el 
cual será controlado de forma remota, utilizando un control de velocidad tipo control Proporcional Integral (PI) para cada 
articulación de las ruedas de tracción y un control Proporcional Integral Derivativo (PID) para mantener la dirección en una 
posición determinada, los cuales se han implementado de manera embebida en la tarjeta STM32F4 Discovery . 


El trabajo está organizado de la siguiente manera: La sección II aborda las principales consideraciones del diseño del robot 
móvil. En la sección III se explica la instrumentación electrónica del robot. En la sección IV se explica la estrategia de control 
implementada y los resultados obtenidos. Finalmente, la última sección presenta las conclusiones del trabajo. 


II. DISEÑO MECANICO DEL ROBOT MÓVIL 


A. Metodologla de diseño. 


Para el diseño del robot móvil se siguen algunas etapas de la metodología propuesta en [14], las cuales se describen a 
continuación: 


1. Entradas de proceso: Se requiere de un robot móvil con la capacidad de transitar sobre terreno poco 
estructurado que cubra con las necesidades establecidas en la tabla 1. 
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Tabla 1. Entradas del proceso 


Desplazamiento sobre terreno El robot móvil debe ser capaz de transitar sobre diferentes tipos de terreno como 
concreto, grava, tierra y arena compacta. 
Capacidad para superar obstáculos Obstáculos de 120mm de altura. 


Tipo de locomoción y suspensión del | Se requiere un sistema adaptable y eficaz con un consumo mínimo de energía y 
robot móvil facilidad en la implementación del control. 


Selección de actuadores eléctricos Tipo de motores a utilizar en la tracción y dirección 


Restricciones de peso y dimensiones Masa y tamaño del robot que permitan el movimiento así como la capacidad para 
subir y bajar pendientes de 35° y de transitar por terreno transversal con pendiente de 
30° 





Estrategia de control y tipo de operacion Se refiere a la manera en la cual sera controlado el movil. 


Estudios de requerimientos. Esta etapa se realiza tomando como base las entradas del proceso, los resultados 
obtenidos se resumen a continuación: 


Desplazamiento sobre terreno. Se seleccionaron llantas de 120mm de diámetro y 60mm de ancho 
fabricadas de caucho cuya superficie proporciona una tracción adecuada para diferentes tipos de terrenos, 
además de absorber vibraciones ocasionadas por las irregularidades del terreno. 

Capacidad para superar obstáculos. Se seleccionó una configuración de suspensión pasiva en forma de 
paralelogramo en la parte frontal y en los laterales, la cual ha mostrado tener la mejor capacidad para 
superar obstáculos y un ejemplo de su aplicación es el robot SOLERO [10]. 

Tipo de locomoción y suspensión del robot móvil. Con la finalidad de combinar la adaptabilidad de las 
patas con la eficiencia de las ruedas, se seleccionó el sistema de locomoción denominado ruedas 
caminantes y con el fin de tener un consumo mínimo de energía y facilitar el control se selecciona una 
suspensión de tipo pasiva. 

Selección de actuadores eléctricos. Para este caso se eligieron motores con caja de reducción de 131.25:1 
de corriente directa alimentados a 12 V para la tracción y la dirección. 

Restricciones de peso y dimensiones. Debido a que se requiere una masa menor a 15 Kg, se seleccionó el 
aluminio como material para la construcción ya que tiene propiedades mecánicas que facilitan el 
mecanizado, alta resistencia a la corrosión y densidad baja. Por otra parte, las dimensiones del móvil no 
deben superar 750mm de largo, 510 mm de ancho y 320mm de alto, con la finalidad de tener la capacidad 
adecuada para superar obstáculos y evitar volcaduras al transitar. 

Estrategia de control y tipo de operación. En este caso la estrategia de control implementada en el robot 
móvil es por medio de juntas independientes, en la cual cada eje es controlado como un sistema de una 
entrada y una salida. 


Diseño conceptual. En esta etapa se desarrolla la distribución de los principales componentes del robot móvil 
los cuales son: El mecanismo frontal (1), mecanismos laterales (2) cuerpo (3) y mecanismos de dirección (4) 
como se muestra en la figura 1. 


Figura 1. Componentes mecánicos del robot móvil. 





Diseño detallado. A lo largo del trabajo se realiza la descripción de las principales partes que componen al 
robot móvil. 
Salida de proceso. A partir del diseño de la figura 1 se pueden crear los planos para la manufactura del robot 


móvil. 
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Por lo anterior, a partir de la metodología descrita se puede desarrollar un robot móvil para desplazamiento en 
terreno agreste y a continuación en cada una de las secciones se describen los aspectos más relevantes para llevarlo a 
cabo. 


B. Mecanismo frontal 


El mecanismo frontal cumple con dos tareas: Garantizar el contacto de la rueda con el piso en todo momento y elevarla 
cuando el móvil se encuentra con un obstáculo para poder superarlo [15]. Para cumplir con esas tareas, se utiliza un 
mecanismo de cinco barras mediante el cual se genera un pivote o centro virtual de giro situado debajo del eje de la rueda 
como se muestra en la figura 2. 


Figura 2. Configuración del mecanismo frontal. 


Movimento resultante 





Fuerga 
aplicada 





Por otra parte, para obtener la configuración que permita superar obstáculos de 120 mm, se realiza un análisis geométrico 
para conocer la posición del punto P localizado en el eje de la rueda delantera de acuerdo a la figura 3. 


Figura 3. Análisis geométrico del mecanismo frontal 





De la figura 3, se obtienen las siguientes ecuaciones: 
TU 
a(0) =p +38 (1) 


y(0)=P+8 (2) 


a= Ib? + c? — 2bcCos(a(6)) (3) 


B = arccos (=) (4) 


2ac 


oe a? +d? — e? : 
= arccos Fad (5) 


n(8) =y(0)-08 (6) 
ccos(8) + hcos(n (6) ) 


csin(6) — hsin(n(0)) g 


P(0) = | 


149 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 15, páginas 147 - 156. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


Utilizando de (1) a (7), se propone el desplazamiento y la trayectoria generada al elevar la rueda de manera suave, para ello 
se realizó una simulación numérica que se muestra en la figura4 con lo cual se determinaron los valores de los eslabones que 
forman el mecanismo frontal cuando chocan con un obstáculo de 120 mm los cuales son: que son b = 55mm c = 145 mm, 
d = 55mm, e = 135 mm yh = 204 mm. 


Figura 4. Trayectoria generada del mecanismo frontal 
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C Mecanismo lateral 


La suspensión lateral es el principal elemento que integra al robot móvil ya que proporciona estabilidad durante el 
movimiento incluso al transitar sobre terreno poco estructurado. Para asegurar una adecuada capacidad de adaptación al 
terreno, es necesario mantener el pivote de giro lo más bajo posible y al mismo tiempo mantenerlo libre de obstáculos [16]. 
Se propone una configuración en forma de paralelogramo con lo que se crea un pivote virtual que cumple con las 
características anteriormente mencionadas, la figura 5 muestra la suspensión propuesta. 


Figura 5. Sistema de suspensión en forma de paralelogramo 





De acuerdo a la figura 6, se obtiene la posición del punto P localizado en el eje de la rueda derecha delantera del mecanismo 


lateral, para simplificar el cálculo se toma la mitad del sistema a partir de los puntos de apoyo E y H que son fijos y se obtiene 
(8). 


Figura 6. Análisis geométrico del mecanismo lateral 
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_( Icos(®) 
a= T —r (8) 


Mediante simulación numérica se obtienen los valores para los eslabones k, l, m, n y r que son: 56mm, 105mm, 56mm 
105mm y 154mm respectivamente En la figura 7, se muestra la posición inicial y final del mecanismo lateral cuando se 
presenta un obstáculo d = 120mm 


Figura 7 Análisis geométrico del mecanismo lateral 
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D Margen de estabilidad 


La estabilidad del robot móvil en forma estacionaria o a velocidad constante se puede definir con el margen de estabilidad 
gravitacional, el cual es la distancia mínima del centro de gravedad proyectado sobre el plano de tierra al borde definido por 
el contacto de las dos ruedas [17]. La pendiente máxima que el robot móvil puede escalar manteniendo la estabilidad se llama 
estabilidad longitudinal y se obtiene mediante (9). Si transita a lo largo de una pendiente se denomina estabilidad transversal 


y se obtiene mediante (10). 
. Ly L2 
p = min {arctan (=) , arctan (2) (9) 


Hl Hl 
= min faretan (Fa) aretan(Z2)} 0 
a. = minjarctan af , arctan Hi (10) 


Tomando en cuenta las características de los mecanismos frontal y lateral del robot móvil y con el fin de cumplir con las 
dimensiones y una distribución uniforme del peso, se tiene que L, = 303mm, L, = 330mm, d, = dz = 202mm y Hl = 
Ht = 188mm, obteniendo lo siguiente: 
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E mf 7) r (=) = 5810 i 
(q = min jarctan TIE , arctan aoa S (11) 


eon) (— 
caretan 


er ela L TMN A (12 
a min farctan nm aaa) AES) 


De las expresiones (11) y (12) se observa que para la estabilidad longitudinal y transversal, se tiene un factor de seguridad de 
1.66 y 1.56 respectivamente, por lo que se cumplen con los requerimientos de diseño y se evitan volcaduras. En la figura 8 
se muestra el margen de estabilidad longitudinal y en la figura 9 el margen de estabilidad transversal 


Figura 8. Margen de estabilidad longitudinal 





Figura 9. Margen de estabilidad transversal. 





III. SISTEMA ELECTRÓNICO. 


El sistema electrónico se divide en dos, la estación base y la estación móvil. En la primera se tiene una computadora con 
una interfaz y un módulo de transmisión inalámbrica mediante, los cuales el usuario manda las instrucciones al robot móvil. 
En la estación móvil, se tienen dos tarjetas de control STM32F4, una configurada como maestro y otra como esclavo. 


La tarjeta configurada como maestro se encarga de recibir la información del transmisor inalámbrico, de la lectura de los 
codificadores ópticos de los motores de tracción, de enviar a la tarjeta configurada como esclavo las señales de posición, 
además de que tiene programados los seis controladores de velocidad para los motores de tracción. 

La tarjeta configurada como esclavo lee los codificadores ópticos de los motores de dirección y tiene programado los 
controladores PID de posición. La figura 10 muestra el diagrama esquemático 
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Los motores utilizados para la tracción y la dirección tienen una caja reductora de relación 131.25 a 1 con un torque de 
18 Kg*cm y velocidad de 80 rpm, el voltaje de alimentación es de 12 V y la corriente máxima con torque es de 5 A. Cuentan 
con codificadores ópticos de 8400 cuentas por revolución y utilizan los drivers VNH5019 Dual como etapa de potencia ya 
que pueden conectarse motores de 5.5 V a 24 V con una corriente máxima de 12 A por canal. 


Figura 10. Diagrama de bloques del sistema electrónico. 
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IV. ESTRATEGIA DE CONTROL. 


Se propone un controlador de velocidad para cada motor de tracción y un control de posición para los motores de dirección. 


En la figura 11 se muestra el diagrama de bloques implementado en la tarjeta STM32F4 Discovery con la ayuda de las 
librerías de Waijung de la compañía Aimaigin para uno de uno de los motores. Se describe a continuación los elementos que 
lo componen: 


1. Bloque de configuración de la tarjeta. Sirve para indicar el modelo de tarjeta a utilizar, el tipo de programador y 
depurador. 

2. Bloque de lectura del codificador óptico. Este bloque lee los pulsos generados por el movimiento del motor. 

3. Bloque de acondicionamiento. Se utiliza para convertir el número de cuentas generado por el codificador óptico en 
revoluciones por minuto para el control de velocidad o en grados para el control de posición. 

4. Bloque de control. Si el motor es de tracción contiene el controlador de velocidad Proporcional Integral PI como se 

muestra en la figura 12(a), de otra manera contiene el control Proporcional Integral Derivativo PID mostrado en la 

figura 12(b) para la dirección. 

Bloque PWM. Realiza la modulación por ancho de pulso que permite variar la velocidad del motor. 

6. Bloque de salidas digitales. Se encarga de mandar la dirección de giro del motor, en sentido horario o antihorario. 


N 
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Figura 11. Diagrama a bloques del control implementado por motor. 
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Figura 12. Controlador Proporcional Integral PI (izquierda), controlador Proporcional Integral Derivativo (derecha) 
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En la figura 12 se muestra el diagrama de bloques del controlador Proporcional Integral y el controlador proporcional 


Integral Derivativo cuyas expresiones matemáticas son (13) y (14). 


User (2) = [Kyi T Ky, a Z~*)|E(Z) (13) 


1 
Upos(Z) = [Kpa + Koa (¿—35) + Kn -ZEZ (14) 


Para verificar el funcionamiento se realizaron dos experimentos uno para tracción y otro para la dirección con los 
controladores propuestos implementados en la tarjeta embebida donde los parámetros Kj, y Ky, para el controlador de 


velocidad son 4.8 y 0.875 respectivamente y para el control de dirección se tiene que Kp2 = 2.5, Kp2 = 0.07 y Kj. = 0.15 


En la figura 13 se observa la respuesta de uno de los motores de tracción ante una señal escalón cuya amplitud es de 40 
RPM, en la gráfica se observa que la respuesta converge a la referencia en un tiempo adecuado y con valor de error de 1RPM. 
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Figura 13. Respuesta del motor de tracción a una señal escalón. 
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En la figura 14, se observa el resultado obtenido al aplicar el controlador de posición en uno de los motores de dirección, 
en este caso, se realizó la prueba con una señal en forma de escalera en la cual se varió el ángulo de 90 a 180 grados y se 
observó que el controlador seguía la señal de error promedio de 1.5 grados. 


Figura 14. Respuesta del motor de dirección. 
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V. CONCLUSIONES. 


La metodología de diseño implementada puede ser aplicada para el diseño de robots móviles dedicados a la exploración de 
terreno poco estructurado facilitando tareas de exploración. Por otra parte con el análisis geométrico realizado en el 
mecanismo lateral y frontal se pueden encontrar numéricamente el valor de cada uno de los eslabones que los constituyen 
con la finalidad de que cumplan con los criterios establecidos de superación de obstáculos y margen de estabilidad 
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transversal y longitudinal. Por último, los controladores implementados en la tarjeta de desarrollo STM32F4 son adecuados 
para el control de tracción y dirección del robot móvil. 
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Determinación analítica del balance estático de un robot bipedo * 


Christian Alberto Matilde Domínguez, Eduardo Morales Sánchez 


Resumen— Este trabajo describe una metodología para determinar el balance estático de un robot bipedo durante la ejecución 
de un ciclo de marcha asimétrico, de manera analítica. El robot es modelado como un árbol cinemático. La localización del robot se 
describe con respecto a un sistema de referencia adjunto al entorno, la posición del centro de masa del robot, así como la posición de 
su base de soporte se determina con respecto a este sistema. 


I. INTRODUCCIÓN 


CICATA Querétaro se planteó, como objetivo a largo plazo, el desarrollo de un robot humanoide de marcha 
dinámicamente balanceada, capaz de operar en ambientes que han sido creados para los humanos. En la primera etapa del 
proyecto se desarrolló un robot bípedo de marcha estáticamente balanceada [1]. En este trabajo se presenta la metodología que 
se utiliza para determinar de manera analítica el balance estático de este robot (fig. 1), durante la ejecución de un ciclo de 
marcha asimétrico, cuando su localización se describe con respecto a un sistema de coordenadas adjunto al entorno. 


Para realizar la determinación del balance estático del robot es necesario: 


1. Obtener el modelo geométrico directo del robot. 
2. Determinar la posición del centro de masa del robot. 
3. Determinar la localización del robot con respecto al entorno. 


En la sección A se describe la metodología para obtener el modelo geométrico directo del robot. En la sección B se 
presenta la ecuación que define la posición del centro de masa del robot, con respecto a un sistema de coordenadas adjunto a 
uno de sus eslabones. En la sección C se mencionan las fases de la marcha bípeda. En la sección D se exponen las ecuaciones 
para describir la localización del robot con respecto al entorno. En la sección E se presentan las ecuaciones para evaluar si se 
satisface la condición de balance estático durante la marcha. Por último, se describe la metodología para determinar el balance 
estático del robot de forma analítica. 
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Figura 1. Robot bipedo de 12 grados de libertad [1]. (a) Vista frontal. (b) Vista lateral. (c) Eslabones y articulaciones. 


II. REQUERIMIENTOS 


A. Modelo geométrico directo del robot 


Se define como el conjunto de matrices de transformación homogénea que se utiliza para determinar la pose de los 
eslabones del robot con respecto al eslabón base, a partir de los vectores de articulación O = [6,, 65,03, 04, 0:, 06]! y 0’ = 
[0;, 03, 03, 04, 05,06)". La metodología para obtener este modelo consiste en: 


1. Asignar sistemas de coordenadas a los eslabones del robot. 

2. Determinar los parámetros que relacionan a los sistemas adjuntos. 

3. Determinar las matrices de transformación individual de las extremidades. 
4. Determinar la pose de cada eslabón con respecto al eslabón base. 
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Se asignan sistemas de coordenadas a los eslabones del robot, como se muestra en la fig. 2, siguiendo la convención 
descrita por [2]. Los sistemas de coordenadas se asignan considerando al robot como un árbol cinemático [3] [4]. Después, se 
determinan los parámetros de Denavit-Hartenberg que describen la geometría de los eslabones del robot y la forma en que se 
conectan (tablas 1 y 2). Se evalúan estos parámetros en la ecuación siguiente [2]: 


cô; —s6; 0 Ai-1 
sO;CQ;_, COC —SQiza SO ¡a d; 
SO;SQ;-1 CO;SQ;_, TSUiz1 Cidi 
0 0 0 1 


= (1) 


para obtener las matrices de transformación individual de las extremidades derecha (i = 1,2,...,6) e izquierda (i = 
1’, 2’, ..., 6°). Por último, se evalúa la ecuación siguiente (i = 2,3, ...,6, 2’, 3’, ..., 6’): 


Op _ Om i-1 
P= TT, (2) 
para determinar las matrices de transformación homogénea restantes, que describen la pose de los eslabones 2 a 6 y 2’ a 6’ con 


respecto al eslabón 0. Las matrices que describen la pose de los eslabones 1 y 1”, con respecto al eslabón 0, se obtienen a partir 
de la ecuación (1). 


El modelo geométrico directo del robot se expresa, en forma compacta, como MGD = {T }-12 61121... La matriz T 
se utiliza para determinar la posición de un punto P, relativa al sistema de coordenadas 0, cuando se conoce su posición con 
respecto a otro sistema de coordenadas (i = 1,2,...,6,1',2',...,6'): 


Pera (3) 


`, ‘ . ‘ 
Tabla 1. Parametros de Denavit-Hartenberg de la extremidad derecha. 
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Figura 2. Asignación de sistemas de coordenadas a los eslabones del robot, 
cuando éste se encuentra en la postura de referencia definida por los vectores 
O = [0°, —90°, 0°, 0°, 0°, 09] y O' = [180°, 90°, 0°, 0°, 0°, O°)’. 
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B. Centro de masa del robot 


El vector de posición del centro de masa (CM) del robot, definido con respecto al sistema de coordenadas 0, esta dado por 
la ecuación siguiente: 


_ mo CM, + X$ m; °T; CM, 


0 
CM l (4) 
Mot ye m; 


donde i = 1,2,...,6,1',2',...,6'. El vector "CM, define la posición del centro de masa del eslabón 1-ésimo con respecto al 
sistema de coordenadas que se le adjuntó. 


C. Fases de la marcha bipeda 


El ciclo de marcha de una extremidad se compone de 4 fases: primer doble soporte (fase 1), soporte simple (fase 2), 
segundo doble soporte (fase 3) y balanceo (fase 4). Al caminar, los ciclos de marcha de las extremidades se desarrollan de 
manera simultánea (fig. 3), de modo que existe una equivalencia entre las fases de ambos, por lo tanto, la marcha bípeda puede 
considerarse como una sucesión alternativa de las fases consecutivas de primer doble soporte y de soporte simple de las 
extremidades [5]. 


Ciclo de marcha de la extremidad izquierda 
PDS SS SDS BAL PDS SS 
PDS SS SDS BAL 
Ciclo de marcha de la extremidad derecha 


PDS: Primer doble soporte; SS: Soporte simple; 
SDS: Segundo doble soporte; BAL: Balanceo. 


Figura 3. Equivalencia entre las fases de los ciclos de marcha de las extremidades derecha e izquierda. 


Un ciclo de marcha puede ser asimétrico o simétrico. En el primer caso, el robot se comporta de forma única durante el 
desarrollo de cada fase, mientras que en el segundo, su comportamiento durante la ejecución de las fases 1 y 2 es equivalente al 
que exhibe al realizar las fases 3 y 4. 


D. Localización del robot con respecto al entorno 


Considérese el vector de posición “P de un punto P. El punto P puede estar definido con respecto al sistema de 
coordenadas 0 u otro, como se estableció en la ecuación (3). La posición del punto P con respecto a un sistema de referencia A 
adjunto al entorno, está dada por: 


apaa T P (5) 


cuando los eslabones del robot se mueven con respecto al pie derecho (fases de primer doble soporte y de soporte simple de la 
extremidad derecha), y por: 


Ap — Am 6'm 0 
PSU PF (6) 


cuando se mueven con respecto al pie izquierdo (fases de primer doble soporte y de soporte simple de la extremidad izquierda). 


Las ecuaciones (5) y (6) se utilizan para determinar la posición, con respecto al sistema de referencia A, de cualquier punto 
definido con respecto a un sistema de coordenadas adjunto a uno de los eslabones del robot. De modo que estas ecuaciones 
permiten: 


1. Determinar la pose de los eslabones del robot con respecto al entorno. 

2. Determinar la trayectoria que el centro de masa del robot describe con respecto al entorno, cuando éste ejecuta un 
ciclo de marcha. 

3. Determinar la base de soporte del robot con respecto al entorno, durante la ejecución de un ciclo de marcha. 


E. Evaluación del balance estático durante la marcha 


Las figs. 4 a 7 muestran la base de soporte del robot durante el desarrollo de un ciclo de marcha asimétrico de la 
extremidad izquierda. La proyección del centro de masa del robot, sobre el suelo, está definida por el punto P de coordenadas 
(x,y). La condición de balance estático se cumple cuando el punto P pertenece a la base de soporte del robot [5], es decir, 
cuando las coordenadas (x,y) satisfacen las 4 desigualdades siguientes, durante el desarrollo de las 4 fases del ciclo de marcha, 
respectivamente: 
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Figura 4. Base de soporte del robot durante la fase de primer doble soporte de 


la extremidad izquierda. 
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Figura 6. Base de soporte del robot durante la fase de segundo doble soporte de 


la extremidad izquierda. 
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Figura 5. Base de soporte del robot durante la fase de soporte simple de la 
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Figura 7. Base de soporte del robot durante la fase de balanceo de la 


extremidad izquierda. 
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III. DETERMINACIÓN DEL BALANCE ESTÁTICO DURANTE LA MARCHA 


Se evalúan las posiciones articulares que definen un ciclo de marcha de la extremidad izquierda en el MGD del robot. Se 
calcula la posición del centro de masa del robot con respecto al sistema de coordenadas 0 y después, con respecto al sistema de 
referencia A. Luego, se determina la posición, con respecto al sistema de referencia A, de los puntos que definen la base de 
soporte del robot, y en general de todos los puntos de interés (fig. 8), durante las fases que componen el ciclo de marcha. Por 
último, se verifica que se cumpla la condición de balance estático en cualquier instante (fig. 9). 


-50 





Figura 8. Puntos de interés del robot. 


Figura 9. Proyección vertical del centro de masa del robot en un instante de 
la fase de segundo doble soporte de la extremidad izquierda. El punto P 
pertenece a la base de soporte del robot. 


Los movimientos articulares que se evaluaron son lentos, por lo tanto, los efectos inerciales no son significativos, y el 
robot es capaz de ejecutar el ciclo de marcha al mantener el balance estatico durante las 4 fases que lo definen (fig. 10), pues 
las únicas fuerzas que actúan sobre éste son su peso y la reacción del suelo. 





(a) (b) (c) (d) 
Figura 10. Robot bipedo en fases de (a) primer doble soporte, (b) soporte simple de la extremidad, (c) segundo doble soporte y (d) balanceo de la extremidad 
izquierda [1]. 
IV. CONCLUSION 


Se describió una metodología para determinar el balance estático de un robot bipedo de forma analítica. La metodología se 
aplicó a un robot, cuya estructura mecánica incorpora 6 articulaciones rotacionales por cada extremidad, sin embargo, ésta es 
independiente del número y el tipo de articulaciones del robot, pues estos factores influyen únicamente en la obtención del 
MGD, por lo tanto, puede aplicarse a un robot que posea n grados de libertad por cada extremidad. 


161 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 16, páginas 157 - 162. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


La metodología descrita es útil para predecir la realización de un ciclo de marcha deseado, cuando los movimientos 
articulares que lo definen son lentos. En la siguiente etapa del proyecto a largo plazo del CICATA Querétaro, se realizará el 
análisis dinámico inverso de un robot que incorpore la distribución de grados de libertad que se muestra en la fig. 1, el cual 
consiste en la determinación de las fuerzas y los pares que actúan sobre los sistemas de coordenadas adjuntos a sus eslabones, 
cuando éste ejecuta un ciclo de marcha deseado, tomando en cuenta la velocidad y la aceleración angular con que se realiza 
cada movimiento articular; y se determinará el balance dinámico de éste durante la marcha sobre una superficie horizontal. 
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Algoritmo de visión embebido para condiciones de iluminación no 
controladas 


J. Contreras’, J. Álvarez”, and J. Herrera? 


Resumen— Los algoritmos de visión requieren de un ambiente con parámetros de iluminación controlados y un sistema 
sofisticado para tener un desempeño adecuado, sin embargo, en el caso de las condiciones de iluminación no controladas y 
especificaciones de diseño compacto, se necesitan emplear otras técnicas para la detección de objetos. Para lo cual, en el presente 
trabajo, se desarrolló un algoritmo óptimo para el sistema embebido aplicado en condiciones no controladas. Se utilizó Matlab- 
Simulink, una cámara de visión de propósito general y una placa de desarrollo Raspberry Pi. Se caracterizó en diferentes 
condiciones de iluminación para determinar los valores de detección de objetos para las condiciones arbitrarias propuestas. El 
algoritmo propuesto cumple con las condiciones mínimas de cálculo para la información obtenida por el sistema embebido en la 
identificación de objetos. El sistema opera con un mínimo consumo de energía, en un tamaño compacto, en diversas condiciones de 
iluminación (que son útiles para las tareas de los robots de navegación), y se ha comprobado la detección del objeto en diferente 
tipo de escenario satisfaciendo el resultado estimado. 


I. INTRODUCCIÓN 


Sucar [1] y González [6] concuerdan que un área muy ligada a la visión computacional es el procesamiento de imágenes, 
cuyo objetivo es extraer características de una imagen para su descripción e interpretación por medio de dispositivos como 
cámaras, laser, entre otros. Sin embargo, algunas aplicaciones no funcionan utilizando las técnicas conocidas, tal es el caso, en 
el ambiente debe ser controlado por dispositivos sofisticados y el tamaño de los equipos requeridos son muy grandes y poco 
portables. 


Los sistemas que requieren obtener información sobre un objeto dado, consideran que la iluminación tiene un papel 
importante en esta práctica. Para ello se requiere una serie de métodos, mecanismos y dispositivos de iluminación que permiten 
el adecuado reconocimiento de objetos. Las aplicaciones no están diseñadas para funcionar sin un sistema de iluminación 
calibrado. A continuación se describen los procesos que intervienen en el reconocimiento de objetos en condiciones 
controladas de iluminación, en el cual se produce un alto consumo de energía y un elevado costo computacional/hardware [3]. 


Los procesos de iluminación integran diferentes tipos de iluminación (retroalimentación difusa, iluminación frontal, luz 
direccional, luz estructurada) y fuentes de iluminación (lámparas incandescentes, tubos fluorescentes, fibra óptica, laser). Con 
este sistema generado se podría obtener información del ambiente y reconstrucciones en 3D [4]. En cuanto a mecanismos 
autónomos la percepción que se le pueda dar, está definida por el tipo de sensores que lo incorpore para obtener información 
del ambiente [5]. En general, la iluminación es uno de los aspectos más importantes para reconocer objetos, ya que no existe 
un algoritmo capaz de reconocerlos en cualquier ambiente de iluminación [3]. 


Considerando las técnicas reportadas anteriormente que utilizan múltiples dispositivos, mecanismos, sistemas 
convencionales y software de procesamiento, no consideran el uso de arquitecturas más eficientes en cuestión de energía, 
tamaño, costo y capacidad de cómputo, por lo tanto, el objetivo del trabajo fue realizar un algoritmo de visión proponiendo otra 
solución de reconocimiento de objetos u obstáculos en un ambiente no controlado por medio de un sistema embebido que se 
comunica por medio de un adaptador WiFi hacía un modem con internet y éste a su vez se comunica a una computadora para 
el envío, recepción y procesamiento de las imágenes capturadas por una cámara conectada al mismo sistema embebido (figura 


1). 





Figura 1. Estructura de dispositivos y herramientas que intervienen para detectar objetos en condiciones no controladas. 
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El presente trabajo aborda la implementación de una cámara web conectada mediante USB a una tarjeta de desarrollo 
Raspberry Pi, que ofrece los recursos necesarios a bajo costo. El utilizar estos dispositivos de éste tipo brindará las prestaciones 
que no se tienen con otras técnicas. El software utilizado es la herramienta MATLAB para la elaboración de éste sistema capaz 
de realizar el procesamiento de imágenes que se envía desde la Raspberry y poder visualizar los resultados en tiempo real de la 
detección de objetos. 


La principal contribución del trabajo ha sido el desarrollo de un algoritmo simple que se encuentra embebido en un sistema 
de bajo consumo de energía, dimensiones reducidas y portabilidad que funciona sin ajustar el entorno y baja resolución. La 
función principal de la visión computacional es reconocer y localizar objetos mediante la información que pueda adquirir un 
dispositivo, utilizando procesamiento de imágenes y construir máquinas que puedan reconocer su entorno con capacidades 
similares a la visión humana. Existen numerosas aplicaciones las cuales dotan a un mecanismo con herramientas para captar el 
entorno y obtener información del mismo [1]: 


e Robótica móvil y vehículos autónomos: se utilizan cámaras y otros tipos de sensores para localizar obstáculos, 
identificar objetos, encontrar caminos. 


e Interpretación de imágenes áreas y de satélite. 


e Análisis e interpretación de imágenes médicas, microscópicas, para astronomía, para comprensión, etc. 


II. FORMACIÓN Y REPRESENTACIÓN DE LA IMAGEN 


Cuando un sensor, una cámara o inclusive el ojo humano registran la radiación en el espectro visible, que ha interactuado 
en un ambiente con ciertos objetos físicos obteniendo información sobre su entorno formando imágenes, es decir, corresponde 
la intensidad o la brillantez (nivel de gris) en cada punto (pixel) de la imagen (asociada a una coordenada (x;, y;)). La imagen 
pude ser representada por una matriz f de dimensiones NxM [6], la función (1) es una representación matemática dado por los 
datos que se obtienen algún dispositivo y que se depositan en la matriz para realizar el análisis y procesamiento de las 
Imágenes. 


Ly 0 Lo 1 Lom 
lizo” = f (xp yi = bo a Un—1m (1) 
ln,0 lnm-1 lnm 


Cada valor de intensidad le corresponde un nivel de gris, que va entre un numero del 0 (negro) al 255 (blanco). Si se 
representan en 3 dimensiones, los dos valores primeros, corresponden a las coordenadas de la imagen (%;, yi) y el tercero 
representa el valor de intensidad (0-255) (figura 2). 


F 





Figura 2. Representación de una imagen de 3 dimensiones. 
El arreglo de las tres dimensiones es una representación de una imagen a color, ya que cada pixel de la imagen se especifica 


por 3 componentes RGB (Red, Green, Blue), uno para cada elemento (x;, y;). Éstos forman los colores primarios e indican los 
valores numéricos que se obtiene de la imagen, pueden ser expresados en un arreglo tridimensional proporcionado por (1): 


f (xi, Yi p) E (fri Vir 1), fei Vir 2); fax Vir 3)) (2) 


Donde p representa el plano en que se está tomando la información, el valor 1 corresponde a la componente R, el valor 2 a 
la componente G y el valor 3 para la componente B. De esta manera se puede realizar procesamiento para cada color. En la 
figura 3, se muestra cómo se asignan valores en cada componente para formar un color específico, de igual manera los valores 
van de 0 (ausencia de color) a 255 (que representa que existe un color en su máxima intensidad). 
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Figura 2.- Valores o niveles de brillantez cuando las imágenes sufren cambios de 
iluminación tanto para imágenes grises y a colores. 


La iluminación es uno de los principales problemas de un mecanismo cuando se encuentra en su entorno, ya que con la 
variación de la misma se tienen muchas dificultades para la adquisición de la información [2]. Para lograr el reconocimiento de 
un objeto, las imágenes obtenidas se separan en unidades significativas, es decir, cada pixel de la imagen se va analizando, 
interpretando y modificando para obtener resultados con diferentes propósitos, a esto se le llama Segmentación. 


Una de las formas que se puede segmentar una imagen es por medio de la determinación de los bordes. El problema radica 
en que las regiones son muy difíciles de encontrar ya que en ocasiones esos segmentos no se puede delimitar como unidades 
significativas. Las características más comunes para delimitar o segmentar regiones son: intensidad de los pixeles, textura, 
color, etc. 


Uno de los problemas que ataca la segmentación es distinguir las variaciones propias del objeto o por cambios de 
iluminación (por ejemplo sombras), que podría tratarse de otro objeto. Existen 3 tipos de técnicas para la segmentación de 
regiones [1]: 


e Locales: agrupan pixeles en base a sus atributos y de los de sus vecinos. 
e Globales: se basan en propiedades globales de la imagen. 
e Division: combinan las técnicas anteriores. 


III. NIVELES DE ANÁLISIS Y VISION 


La visión computacional se observa como un proceso de información, el cual se puede analizar de diversas formas, se 
propone 3 niveles [1]: 


1. Teoría Computacional: metas y estrategias para analizar la información. 
2. Representación y algoritmo: se describe el proceso del algoritmo para representar las entradas y salidas de variables. 
3. Implementación: como se realiza fisicamente. 


La visión consiste en obtener la información de una imagen y dividirla, ya que el proceso o los métodos son muy 
complejos, en cada etapa se va delimitando hasta llegar a la descripción deseada. Se conocen 3 niveles [1]: 


e Procesamiento de nivel bajo: se utiliza para obtener contornos, gradiente, color, etc. 


e Procesamiento de nivel intermedio: se agrupan elementos para obtener líneas, figuras poligonales, etc. 


e Procesamiento de alto nivel: modelos o software especializado para el tratado de la información. 
IV. DISEÑO DEL ALGORITMO E IMPLEMENTACIÓN 


Hay diversos algoritmos que se pueden utilizar para reconocer objetos en un determinado ambiente natural, pero siendo un 
escenario diferente, con variación de la intensidad de luz, es muy difícil poder reconocerlos especificamente ya que su 
estructura de igual forma va cambiando de modo que lo detecta la cámara, el siguiente algoritmo tiene la finalidad de detectar 
los objetos con variación de la intensidad de luz. 


La adquisición de los datos se obtiene por medio de una cámara web y se almacenan todos los valores existentes que 
pudiera conformar la escena en una matriz específicamente para el procesamiento correspondiente. El tamaño de la matriz 
(NxM) puede ser fijo o dinámico, ya que depende de la resolución de la cámara. Se recorre la matriz de izquierda a derecha y 
de arriba hacia abajo hasta recorrer todos los valores de la escena para separar los 3 componentes fundamentales dado por (2) 
se obtienen (3): 


Para i = 0 hasta N 
Para j = 0 hasta M (3) 
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fr GJ, 1) = matriz (1, j,1); 
Te.) 2) = Matriz ll,J,2) 
fas, 3) = matriz (i j, 3); 


A partir de (3) podemos realizar el procesamiento que se requiera, tomando cada uno de los colores primarios por separado. 
Se requiere tener la imagen en escala de grises de manera que los objetos queden separados del fondo, aplicando una etiqueta a 
los componentes de mayor aproximación para extraer centros que estén presentes en la imagen. La escala de grises se obtiene 
sumando las 3 componentes y dividirlas entre 3 (4). 


¡Moris = fers, 1) T feGs, 2) + fsi j, 3))/3 (4) 


Posteriormente se requiere una imagen binaria con el fin de encontrar puntos en blanco y en negro para delimitar 
contornos o bordes. Para los bordes encontrados, limpiar el interior del objeto es una de las formas de detección, una forma 
de hacerlo es condicionando el valor de intensidad, si el valor del pixel supera el valor de intensidad definido (umbral). El 
pixel se le asigna un 0 (la imagen o la zona será de color negro), si no, el pixel se le asigna el valor 255 (color en blanco). El 
umbral permite tener un amplio margen de detección del objeto, ya que el límite que se le pueda dar, formará un objeto y 
parte de un fondo. Una vez encontrado los límites del área del objeto se establece la distancia para localizar un punto central 
de la imagen. Se sabe que la distancia se calcula con (5): 


d= (x2 — x1)? + (y2 — y1)? (5) 


Posteriormente mide la región en donde se encuentre el objeto sobre componentes marcados con valores a 0, cada 
componente tendrá su elemento identificado. Realiza el mismo procedimiento hasta que detecte el centro del objeto. 
Operaciones con los ejes cartesianos con una distancia de 10 centímetros, que se le ha puesto como límite en los parámetros 
para la detección del objeto. Mostrará en pantalla el objeto detectado y la distancia que tiene sobre él. 


La implementación de este tipo de algoritmo donde se utiliza la adquisición de imágenes en tiempo real, Matlab es un 
software muy eficaz ya que permite analizar datos por medio de matrices, realizar procesamiento de imágenes, crear modelos 
y aplicaciones complejas. Matlab incluye el paquete de Simulink, que ofrece la capacidad de programar hardware de bajo 
costo y que contiene una serie de herramientas para estos fines [7]. Una de ellas es el soporte de hardware para Raspberry Pi, 
ya que habilita la comunicación remota con Matlab. La Raspberry Pi es una computadora completa funcional de bajo costo 
basado en un procesador ARM11, que permite el desarrollo de diversos proyectos de enseñanza en diversas áreas [8]. Se 
utilizó una computadora convencional, donde se instaló Matlab versión 2015, una cámara web de propósito general, una 
Raspberry Pi 2 B+ con un adaptador WiF1 para realizar la comunicación inalámbricamente (ya que también se puede realizar 
mediante cable Ethernet), un router para la conexión a internet y tarjeta de memoria SD de 8GB para instalar el sistema 
operativo de la Raspberry Pi. 


Para realizar la comunicacion entre la Raspberry Pi y Matlab, Matlab se encarga de proporcionar el sistema operativo de 
la Raspberry Pi (Raspbian) que a su vez tiene precargado herramientas para la comunicación con Simulink, que por medio de 
bloques permite la interacción con la información proveniente de la Raspberry Pi. Cuando Matlab termina de instalar el 
sistema operativo a la microSd con Raspbian, muestra 3 opciones para realizar la comunicación remota, localmente 
conectado al router, conectado directamente a la computadora, o manualmente ingresando un IP estática. En este caso se 
configuró la Raspberry Pi con una IP estática ya que la red es local. Inicialmente se configuraron la conexión de red tanto de 
la Raspberry Pi cómo de la computadora por medio de WiFi con la finalidad de estar conectados a la misma red. En la 
consola de Matlab se ingresa la siguiente instrucción para conectar la Raspberry Pi, se crea un objeto h con los siguientes 
datos: 

h = raspberrypi('IPaddress'.'user name”, 'password”); 


Se crea un objeto con el nombre de la variable A con los datos descritos en la instrucción. Confirmar que se ha conectado 
satisfactoriamente el enlace, se utiliza la siguiente instrucción: 


message = h.connect 


El modelo de la figura 3, fue realizado en Simulink, con bloques de procesamiento de imágenes. 
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Figura 3. Modelo a bloques para el procesamiento de imagenes. 


En la figura 3, se muestra como se realiza la captura de imagenes desde la Raspberry, con el bloque de Simulink, V4L2 
Video Capture, el cual realiza la captura de video desde la cámara web USB en formato RGB con una resolución de 760 * 
120 pixeles, constantemente envía información por medio de la conexión remota, Matlab recibe los datos en el siguiente 
bloque, Matlab Function, permite agregar código para realizar el procesamiento de las imágenes con su propio lenguaje de 
programación. En la función fromRGB se encuentra éste código donde se especifican las entradas (datos provenientes del 
bloque V4L2 Video Capture) y las salidas (variables para mostrar en pantalla o enviar a otro bloque). Como se muestra en la 
figura 3, las variables de entrada y que almacenan la información son: Rin, Gin, Bin, y las variables de salida son R, G, B, 
éstas se enviarán al bloque SDL Video Display para visualizar el resultado del procesamiento y la última salida distancia, se 
envía a un bloque Display 1 para visualizar la distancia que existe entre la cámara y el objeto. 


Una función de Matlab que nos permite obtener en una sola matriz y utilizar los valores de una imagen a color, es decir, los 
3 componentes, se utiliza cat: 


img = cat (3, Rin, Gin, Bin); 


Donde el valor 3 se especifica para matrices multidimensionales, img almacena los valores concatenados de las matrices. 
Se declaran las variables correspondientes a la resolución NxM, en este caso 160 * 120, posteriormente se obtienen los valores 
de la escena recorriendo toda la imagen y aplicando el primer proceso, convertir la escena a escala de grises para obtener 
valores entre 0 y 255. Para convertir una imagen RGB a escala de grises, se debe sumar las 3 componentes y dividirlas entre 3. 
Aplicando (3) y (4) el código queda de la siguiente manera: 


Para i = 0 hasta 160 
Para j = 0 hasta 120 
Tali: 1) = (img UN 1) T img CAE 2) T img (GJ 3))/3; (6) 
fei j, 2) = (img (i j,1) + img Gj, 2) + img (i j, 3))/3; 
fsi j,3) = (img (i, j,1) + img (i, j, 2) + img (Ci j, 3))/3; 


Se comparan los valores obtenidos en el proceso anterior a un valor de intensidad determinado (umbral) para obtener una 
imagen binaria, en este caso el valor del umbral es de 80. Si el componente en su color es menor a 80 reemplazará esos 
valores colocando un 0 (negro) y si es mayor pondrá un valor de 255 (blanco). Se puede utilizar sólo un componente ya que 
todos los componentes tienen el mismo valor después de convertir la imagen a escala de grises. 


if (fej, 1)) > 80 
frj, 1) = 200 
else (7) 
frj, 1) = 0; 


Conseguir la distancia entre el punto del objeto y la cámara se obtendrá por (5), Matlab proporciona la función sqrt para 
obtener la raíz de un valor (8). 


distancia = sqrt((x> — x1)? + (y, — y1)”) (8) 
Buscara los valores identificados con 0 para encontrar el contorno del objeto encontrado, si el objeto tiene valores 


dispersos dentro de su contorno, los pondra a 0. La distancia la muestra en un bloque tipo Display para visualizar su valor en 
la simulación. 
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V. RESULTADOS 


Durante el desarrollo de este trabajo se realizaron diferentes pruebas las cuales llevaron a efectuar cambios en lo que se 
refiere a la resolución, ya que a mayor resolución de la cámara, es mayor el procesamiento que se consume en el sistema, 
considerando un retraso mayor a lo esperado. Por lo cual se elige de menor resolución para un mejor aprovechamiento de 
tiempo y costo computacional. 


En la figura 4 se muestra el resultado experimental que se obtuvo, con el reconocimiento esperado para condiciones de 
iluminación no controladas, a fin de lograr el nivel de detección deseado. Se llevó acabo en un lugar cerrado a muy poca luz y 
con dos botellas de plástico, reconociendo éstos dos objetos por medio de su contorno. 


De esta manera aunque el objeto cambie su apariencia debido a los cambios de iluminación, el sistema embebido será 
capaz de conocerlo hasta cierto punto. El umbral definido mostró un mejor resultado ya que el objeto detectado se muestra con 
mayor precisión del contorno. 











sea the ratios Rector, P ra diget (EA 1:20 trar rrtr 


Figura 4. Resultados del sistema embebido reconociendo objetos en condiciones no controladas. 


VI. CONCLUSIÓN 


Con los resultados obtenidos se puede concluir que se ha conseguido crear un sistema embebido capaz de reconocer 
objetos en condiciones no controladas de iluminación, permitiendo la reducción de costos computacionales, el bajo consumo 
de energía y una mayor portabilidad del sistema. MATLAB y Simulink facilitan un entorno que permite acelerar la 
investigación, reducir los tiempos de análisis y desarrollo e implementar aplicaciones complejas en dispositivos de bajos 
recursos. Se demostró el uso de arquitecturas más eficientes como la Raspberry Pi para el procesamiento de imágenes 
logrando un mejor desempeño ante condiciones no ideales. Cómo trabajo a futuro se propone diseñar un prototipo y realizar 
la implementación de éste sistema embebido con la finalidad que sea autónomo, esquivando objetos de acuerdo a lo que 
capture y vaya detectando la cámara teniendo una distancia mínima para moverse a la derecha o a la izquierda. Ampliar las 
funcionalidades de Matlab-Simulink con bloques más complejos para la adquisición y procesamiento de imágenes de tal 
forma reducir código que pueda funcionar de forma independiente. 
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Resumen — La demanda de servicios de terapia para rehabilitación del movimiento de las manos se ha 
incrementado en los últimos años. Se propone un exoesqueleto para movilizar los dedos de la mano en 
ejercicios de flexoextensión y oposición del dedo pulgar. El exoesqueleto para cada dedo puede ser ajustado a 
la longitud particular de los dedos del usuario. Los movimientos realizados por el exoesqueleto corresponden a 
la trayectoria natural de flexoextensión y oposición de los dedos de la mano para evitar dolor al usuario. La 
amplitud de la rotación de las articulaciones metacarpofalángica (MCP) e interfalángica proximal (PIP), 
tienen un intervalo de 0 to 90° y la articulación interfalángica distal (DIP) de 0 to 60°; las rotaciones de las 
articulaciones son coordinadas naturalmente. Los componentes del exoesqueleto son realizados mediante 
impresión 3D, lo que resulta en un dispositivo efectivo y de bajo costo. La personalización de las dimensiones 
del dispositivo permite cubrir un importante porcentaje de la población adulta. 


I. INTRODUCCIÓN 


En el estado de Querétaro no se cuenta con sistemas robóticos para auxiliar en la rehabilitación física de 
personas, ya que las terapias se aplican por terapeutas apoyados en sistemas de rehabilitación manuales. Por 
otra parte, se ha comprobado que el uso de sistemas robóticos en las terapias de rehabilitación incrementan los 
beneficios respecto a las terapias manuales al incorporar tareas de ejercicio intensivas e interactivas [1]. Aun 
cuando los sistemas robóticos no reemplazan a los terapeutas, constituyen una valiosa herramienta en el 
tratamiento de discapacidades [2]. 


El desarrollo de exoesqueletos para rehabilitación de la mano ha avanzado más lentamente que para otras 
partes del cuerpo debido en parte a las altas exigencias de capacidades de motorización y sensado [3]. The 
rutgers master II ha sido una de los primeros exoesqueletos para rehabilitación de mano; fue propuesto por 
Bouzit, Burdea, Popescu, y Boian en 2002 [4]. Éste es un exoesqueleto tipo guante que interacciona con un 
ambiente virtual 3D en tiempo real; se instrumentó usando actuadores neumáticos (servo válvulas neumáticas) 
y sensores de efecto hall para medir los ángulos de flexión y aducción, Figural. 
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Figura 1 The rutgers master II [4] 
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También enfocados en la rehabilitación, [5] desarrollaron un exoesqueleto para la rehabilitación de la mano, 
empezando con la construcción de un prototipo mecánico de cuatro grados de libertad, el cual es movido por 
una unidad actuadora con motor de CD y reductor de velocidad. 


En Figura 2 se muestra el exoesqueleto desarrollados por Wege y Zimmermann. Un problema presente en los 
exoesqueletos es que resulta muy complejo modificar sus dimensiones para adaptarlos al tamaño de las manos 
de los usuarios. Además, la masa del exoesqueleto debe ser cargado por la mano del usuario, lo que pronto 
puede provocar fatiga y reducir el tiempo de ejercicio. 





o 
> 


~ 





Figura 2 Exoesqueleto para la rehabilitación de la mano [6] 
II. MODELO CINEMÁTICO DE LA MANO 


El modelado cinemático de la mano es un problema complejo, para atender este problema se han aplicado 
técnicas de la robótica [7]. El planteamiento consiste en considerar la mano humana como una cadena 
cinemática ramificada. La mano es claramente el conjunto articulado más complejo del esqueleto humano, 
jerárquicamente puede ser establecido en dos grupos cinemáticos: (1) los dedos largos y el pulgar y (11) los 
huesos del carpo [7]. Se puede plantear un modelo simplificado si se considera a la palma de la mano como una 
base fija y a cada uno de los dedos como una cadena cinemática abierta, Figura 3. 


Un planteamiento realista para realizar la flexoextensión de los dedos en terapias de rehabilitación puede 
considerar para cada uno de los dedos, índice a meñique, una cadena cinemática de cuatro eslabones y cinco 
articulaciones a partir de la muñeca [8]. La ecuaciones del modelo cinemático pueden calcularse por medio de 
los parámetros de Denavit-Hartenberg (DH), esta convención se utiliza comúnmente en el modelado de 
mecanismos y de robótica [9]. La ecuaciones del modelo cinemático pueden calcularse por medio de los 
parámetros de Denavit-Hartenberg (DH), esta convención se utiliza comúnmente en el modelado de 
mecanismos y de robótica [9]. 





Figura 3 Modelo cinemático de la mano considerando la palma fija 


En la Tabla 1 se muestran los parámetros de DH para el dedo pulgar propuesta por [8]. La Tabla 2 presenta los 
parámetros de DH para los dedos largos: índice, medio, anular y meñique. 
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Tabla 1 Parámetros de DH para el pulgar 


E o a Tw [a 
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Dónde: L;, L> y L; son las longitudes del metacarpiano y las falanges proximal y distal del pulgar 
respectivamente. La flexoextensión de los dedos largos ocurre en un plano distinto para cada dedo; además, la 
abducción es nula en flexión completa pero alcanza su movimiento máximo en extensión completa [10]. 





Tabla 2 Parámetros de DH para los dedos largos 
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La, Ls, Ls y L7, son las longitudes del metacarpiano y las falanges proximal, medial y distal de los dedos largos 
respectivamente. 





En Figura 4 se ilustra la flexión del dedo índice con movimiento de flexión de las articulaciones 
metacarpofalángica e interfalángicas de 0 a 90° con origen en la articulación metacarpofalángica. 


Index Finger Kinematics (0 - Pi/2) 








Figura 4 Simulación de flexión del dedo índice 


La movilidad del modelo cinemático ramificado es determinado considerando todas las articulaciones 
independientes, sin embargo, el sistema nervioso central coordina los movimientos de las articulaciones para la 
realización de distintos tipos de tareas creando sinergias. Estas sinergias existen de manera natural al manipular 
objetos o utilizar herramientas. 


Por otra parte, existen restricciones de movimiento de la mano están divididas en dos grandes grupos: 
restricciones estáticas y restricciones dinámicas debidas a las dependencias entre ángulos de las articulaciones 


[11]. 
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Tabla 3 Restricciones estáticas para el pulgar 


Dedo / Articulación Identific Flexión Extensión Abducción / 
ador aducción 
Pulgar III IO IO IO 


Trapecio-metacarpiana_| TMC | 50%90% | 15% | 45°60" 
Metacapofalángica | MCF | 75%-80% | o0 | o > 
Finterfaléngiea | TF] 75°- 80° | 59-100 | 0? 


Las restricciones estaticas se refieren a los limites de movimiento de las articulaciones y han sido establecidos 
valores estándar en la fisiología articular (Kapandji, 2006), Tablas 3 y 4. Las restricciones dinámicas son 
debidas a la relación de movimiento entre articulaciones; una de las más importantes es la relación entre las 
articulaciones IFD e IFP para los cuatro dedos largos, está establecida por ec. (1) [12] [13]. 


2 


Oro = (5 
IFD 3 





) vee dd 


Flexión de los dedos de la mano 





Le S< 
80 





Figura 3 Simulación de movimientos de flexión de los dedos y oposición del pulgar 


I. EXOESQUELETO PROPUESTO 


Para satisfacer los requerimientos de flexoextensión de los dedos largos y oposición del pulgar, se ha propuesto 
un guante tipo exoesqueleto accionado por cables a manera de tendones. Inspirado en el accionamiento natural 
de los dedos, en este mecanismo se tienen dos tendones artificiales, uno flexor y otro extensor por cada dedo. 


La estrategia seleccionada consiste en fabricar los componentes de los segmentos del exoesqueleto a la medida 
de las dimensiones de los dedos de la mano que se desea rehabilitar. Esta fabricación se simplifica con la 
disponibilidad de imprimir en tres dimensiones las piezas en plástico Poliacido Láctico (PLA), el cual es un 
polímero biodegradable proveniente del almidón del maíz, suficientemente rígido y resistente para este 
propósito. Además, el costo de fabricación de las piezas correspondientes a los dedos de una mano incluyendo 
el pulgar es aproximadamente un mil quinientos pesos mexicanos, lo que resulta en un costo viable para la 
personalización del exoesqueleto para cada paciente. El tiempo de impresión de los componentes del 
exoesqueleto permite construirlo en tiempo promedio de un día. 
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Tabla 4 Restricciones estáticas para los dedos largos [7][8] 


aducción 
me ooo oa ISI IES IE 
Capman MO] o 
Metacapoalingea | ma | o% | | 
Trtertalángiea Proximal | mr | mo | o 

interfalingica Distal | mD |0 s j o 
Medio 
Carpomeacaal MO] o 
[Metacapofalingica | ma 90 |o 
Interfalángica Proximal | FP | 110° | œ | 

nterfaléngica Distal | mD |0| s j o 
aww o ooo a o 
Carpomeacaal MO] 
Metacapolalingica | ma | o% |o 
Interfalángica Proximal P | 120° [| 0% | 

interfalingica Distal | mD |æ- | 
Maw o o’ O o SS 
Capman | oe | e o 
Metacapoalingea | mæ | o% OA [50 
Tmertalángiea Proximal | me [BA 
interfalingica Distal | mD | % | s o 


La fabricación de los tres componentes del exoesqueleto de un dedo, proximal, medial y distal, dependen 
básicamente de tres dimensiones: longitud (L), altura (H) y anchura (W) de cada segmento del dedo. Otra 
característica de los segmentos del exoesqueleto es que son muy ligeros, menos de diez gramos por cada 
componente, lo que resulta cómodo para el usuario. Para el diseño y construcción de un prototipo se consideran 
las dimensiones de una mano en particular de la Tabla 5. 





Tabla 5a Dimensiones de una mano en particular para el diseño del exoesqueleto 


Segmento | r 
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Tabla 5b Dimensiones de una mano en particular para el diseño del exoesqueleto 


Dedo | Amular 
Segmento | OL | _H__| OW 
Proximal (mm) 


20.21 











Figura 6 Componente IEXOP correspondiente al segmento proximal del dedo 


Se ha diseñado cada segmento del exoesqueleto para su correspondiente segmento del dedo, el primero tiene 
dos guías por las cuales pasan los cables de los tendones flexor y extensor. El tendón extensor es un cable de 
acero de 1.66 mm (1/16 pulgada) de diámetro, el cual por su grosor sirve de guía a todo el exoesqueleto para 
evitar que se flexionen de manera lateral las articulaciones IFP e IFD. En Figura 6 se muestra el componente 
denominado IEXOP debido a que corresponde al segmento proximal del dedo índice. Las figuras 7 y 8 
muestran los componentes denominados IEXOM e IEXOD debido a que corresponde al segmento proximal 
del dedo índice. La Figura 9 ilustra el Ensamble del exoesqueleto para el dedo índice. 
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Figura 8 Componente IEXOD correspondiente al segmento distal del dedo 


Las secciones rígidas del exoesqueleto sujetan los segmentos del dedo permitiendo la rotación natural de las 
articulaciones por la fuerza ejercida en puntos específicos del exoesqueleto. Los tendones artificiales están 
ubicados a lo largo del dedo en la parte dorsal media de tal manera que provocan una alineación natural de las 
falanges. Para encontrar un modelo simplificado pero funcional de los dedos, se considera cada uno de ellos 
como una cadena cinemática abierta de cuatro grados de libertad con la base en la palma de la mano, la cual 
es considerada como el eslabón 1 (fijo). La Figura 10 muestra el modelo propuesto que considera sólo tres 
GDL para realizar la flexoextensión. En esta simplificación del modelo del dedo, cada uno de los eslabones es 
considerado como un cuerpo rígido de longitud fija y sección transversal circular, su centro de masas CGi se 
establece en la parte central del eslabón. El eje de rotación de la primera articulación se asigna al punto O, el 
ángulo de rotación es 82, el punto A representa el extremo del eslabón 2. El peso del eslabón 2 se representa 
por la fuerza g2, la cual actúa siempre en dirección de la aceleración de la gravedad. Se asume que el torque 
T12 produce el movimiento de flexo-extensión del eslabón 2 (FP), en ausencia de este torque la fuerza Fp2 
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produce el mismo movimiento. 





Figura 10 Modelo del dedo como una cadena cinemática de tres GDL 


En la flexión del dedo medio, que es el más largo, se tiene el mayor incremento en la longitud del tendón 
flexor, que es también la carrera del actuador lineal. 


El tendón artificial tendrá una longitud inicial: 


La (2) 


Li = Lo t La t ) 


El incremento en la longitud L, debida a la rotación de la articulación MCF es 


2 TT * H,» (3) 
me a” 





Para 0.5H>=19.25 mm, AL, = 15.11 mm; 0.5H3;=15.25 mm, AL; = 11.97 mm; 0.5H,=14.25 mm, 
AL, = 11.19 mm; 


La carrera del actuador lineal es 


Alt — AL, + AL3 + AL, (4) 
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AL = 15.11 + 11.97 + 11.19 =38.28 mm 


Por lo anterior, se ha seleccionado el actuador de la marca Firgelli ® modelo L12 50 100 12 I, En 
Figura 11 se muestra el actuador seleccionado. 


se E 


Figura 11 Actuador lineal eléctrico 


IV. RESULTADOS 


El prototipo construido del exoesqueleto propuesto se muestra en Figura 12, se pueden apreciar los segmentos 
correspondientes a las falanges de los cinco dedos. 





Figura 12 Guante tipo exoesqueleto propuesto 


En Figura 13 se muestran tres imágenes de una secuencia de flexión de los dedos largos. 





Figura 13 Flexión de los dedos largos 
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Los resultados de la simulación cinemática del modelo del dedo como una cadena cinemática de tres GDL, 
correspondiente a la figura 10, se muestran en las figuras 14, punto A, y 15 punto D. 
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Figura 14 Posición, velocidad y aceleración del punto A 
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Figura 15 Posición, velocidad y aceleración del punto D 


V. CONCLUSIÓN 


A partir de las primeras visitas al Centro de Rehabilitación Integral de Querétaro se han identificado áreas de 
oportunidad para el desarrollo de proyectos de investigación de ciencia aplicada y tecnología avanzada de 
gran necesidad en el sector salud de nuestro país. En particular se identificó la necesidad de desarrollar un 
sistema de rehabilitación de mano ya que actualmente las movilizaciones de los dedos de la mano las realizan 
los terapeutas de forma manual. Por otra parte, se ha revisado la biomecánica y cinemática directa de la mano, 
lo cual ha permitido contar con el conocimiento necesario para la conceptualización de dos sistemas de 
rehabilitación para la mano, uno flexible tipo exoesqueleto. 


A partir de la construcción de prototipos que se desarrolla actualmente y su evaluación, se podrá seleccionar 
el más adecuado para su construcción definitiva. El trabajo a desarrollar de forma inmediata consiste en la 
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conclusión de la construcción del exoesqueleto y su evaluación funcional. A mediano plazo se contempla el 
diseño y construcción del controlador correspondiente, así como la instrumentación necesaria para la 
medición de fuerza en los tendones artificiales y flexión de las articulaciones. 
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Reference trajectory generation for a knee assistive device 
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Abstract. The assistive devices for physical therapy require reference trajectories to provide personalized service, according to the physical 
requirements of each patient and according to the medical diagnostic. This paper presents a method to generated reference trajectories for a 
personalized therapy in a knee assistive device. The method automatically selects the order of polynomials to fit a set of trajectories performed 
by the patient. The polynomials are calculated by using regression analysis. The method is applied by using a knee assistive device; several 
therapist demonstrations of four knee exercises are acquired and processed to obtain the reference trajectories. In addition, the demonstration 


that fits better all the stored trajectories is selected. 


Keywords: Reference trajectories, regression analysis, medical robotics, physical therapy. 


I. INTRODUCTION 


Mechanical Rehabilitation therapy varies for each patient according to the physical characteristics, the type of injury or 
illness, and the medical diagnostic, among others. Therefore, a physical rehabilitation device should reproduce a different 
trajectory for each patient. However, many assistive devices for limb rehabilitation only reproduce predefined trajectories 
(Refs.[1, 2]) without ability to adapt to the therapy of each patient. On the other hand, some of the most advanced limb 
rehabilitation robots remember the positions of a movement demonstrated by the therapist and after they reproduce the 
remembered positions, however, they reproduce the exact recorded trajectory from just one sample. Among these, 
ARMIN (Ref. [3]) for upper limb rehabilitation and Physiotherabot (Ref. [4]) for lower limb rehabilitation. However, 
human motion can’t be represented by a single demo because it may contain errors due to: interaction between therapist, 
patient and robot; changes in speed and acceleration; and possible therapist hesitation. The movement should be learned 
by processing several demonstrations of the movement (Ref. [5]). 


The rehabilitation robotics, considering trajectory generation, has focused on the characterization of the normal gait, 
with applications principally in correcting posture by exoskeletons, and the development of adaptive controls for 
reproducing trajectories (Refs. [6, 7]). Generation and selection of human movement trajectories have been studied more 
extensively in humanoid robotics, specifically in learning by imitation, learning by demonstration or programming by 
demonstration (Refs. [8, 9]). 


In this paper, trajectories of knee exercises are stored by using knee assistive device and reference trajectories are 
successfully generated by regression. The proposed method provides greater flexibility to the therapy responding to 
specific requirements for each patient. Since regression analysis method fits the curves by using an order polynomial 
previously selected by the user, the technical relevance of this paper is that the order polynomial is automatically selected 
by evaluation of the slopes of the error curves. 


II. EXERCISE DEMONSTRATIONS BY USING THE ASSISTIVE DEVICE 


A knee assistive device, developed at IPN-CICATA, QRO., has been used for the experimentation. The mechanism is 
based on a five-bar mechanism with two degrees of freedom (Ref. [10]). The end effector of the mechanism supports the 
ankle and guides the patient’s leg while a rehabilitation exercise is reproduced; it can reproduce several trajectories inside 
its work space. The device has encoders (position sensors) on its joints R, and R, which are fixed to the mechanism 
base, where the P, and P, are the prismatic joints and each R; is a rotational joint, Fig. 1. 
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Fig. 1 Scheme of the knee rehabilitation device 


Four exercises have been performed on the device while joints positions R, and R, have been sampled every 25ms. 
Sets of ten trajectories has been obtained for each exercise. Using the joints positions of R, and R,, the end effector 
mechanism trajectories (X, Y) has been calculated by means of the forward kinematic. Every trajectory stored by the 
device has been also named “Demonstration”. The exercises have been advised by specialists from CRIQ (Integral 
Rehabilitation Center of Queretaro). Fig. 2 shows the four knee rehabilitation exercises performed by a therapist and Fig. 
3 shows a picture of the final prototype of the knee assistive device while an exercise is demonstrated with a person. 








Fig. 2 Knee exercises recommended by the therapist. 


182 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 19, páginas 181 - 191. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 





Fig. 3 Knee assistive device 


In this stage, the trajectories of four knee exercises have been stored by the device as example to apply the method. 
However, the trajectories should be updated in each therapy session by using samples from each patient. Therefore, the 
therapist can teach the desired trajectories to the assistive device. 


IHI. AUTOMATIC SELECTION OF THE ORDER POLYNOMIAL FOR CURVE GENERATION BY REGRESSION 


The regression method founds the coefficients of a polynomial with a known order polynomial under the minimum 
error criterion (Eq. 1). Where Í is the generated values for the evaluated Cartesian component (X or Y); b is the valuated 
Cartesian component; i is the position array and k is the length of the data. 


k 
E= X (b-b) (1) 
2, 


The regression method calculates the coefficients polynomials which best fit a curve but the order polynomials should 
be selected by the user. Thus, in order to automatically select the order polynomial N and M, for the Cartesian 
Components X and Y respectively, the error curves have been evaluated (Refs. [11-14]), from residues between the input 
data and the predicted data. The input data contains the values of the trajectories stored by the assistive device 
(demonstrations) and the output data contains the values of the reference trajectory generated by regression. The residual 
distance r; formed between the input curve (x, y) and the predicted curve (X, Y) is given by, 


==)" + Oi- y)? (2) 


And the error for each evaluated demonstration is given by, 


k 2 
eXY, = a (3) 
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Where d is the evaluated demonstration. The average error is given by, 


D 
eXYP = soii (4) 


Where D is the total of evaluated demonstrations. 


The proposed method varies the order polynomial for both X axis and Y axis data, permuting different orders by 
scanning in different ranges from | to 1, | to 2, ..., 1 to 20, each scanning evaluates the permutations from de minimum 
value of the range to maximum value of the range. Then, the polynomial permutation with the smallest error is selected in 
each scanning (to reduce the data to a select group of 20 permutations) and a curve is generated displaying the error 
behavior. The method was applied for several sets of demonstrations for the four exercises. 


According to the normalized error curves, the error value decreases while the order of the polynomials increases; until 
that the error reduction is not appreciable. When the error reduction is not appreciable, the polynomials with high order 
are not useful. In order to detect when the error reduction is not appreciable, the slope of the error curve has been used to 
select the best permutation polynomial. The curve slope “m”, of Fig. 4, can be calculated as: 


m = |(EXY Posty -_ OXY Pa) Sara) — (Sy ))| (5) 
Where, m is the slope of curve; s is the scan number and n is the position array. 


When m<l.0 for first time, s, is selected. Every s, has a preselected permutation polynomial with the 
minimum eXYP (,,, , then both sn and its corresponding permutation polynomial are automatically selected. As example, 
from the exercise A, Table 1 shows each scanning “s,” with its corresponding evaluation range and the selected 
permutation polynomial exhibiting smallest eXYP. 


Table 1 eXYP- exercise A 


Permutation exhibiting smallest eXYP 





Normalized eXYP 
100 
48.01395 
4.662821 
0.635522 
0.577902 
Oo 6 | 6 | 0208954 
pT | e | 0197304 
po 80132746 
pO 012.7653 
pO 012.7526 
=o o 0127133 
0.125686 
0.124794 
0.118259 
0.112054 
0.075605 
0.062099 
0.022913 
0.015346 
0 | e | 
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From Table 1 the error curve has been obtained, Fig. 4. With the first found m<1.0, the scanning 4 has been selected, 
the curve shows that the error has a marked decrease until scanning 4, without significant changes from scanning 4 to 
end. 4" order polynomial for both X data and Y data correspond to the scanning 4 (M=4, N=4). The polynomials M=4 
and N=4 show fit to the real shape of the exercise A. The curve obtained for exercise A versus demonstrated curves are 
observed in Fig. 5. In the case of the exercise A, 4" order polynomials are a good choice in terms of error, for both the X 
curve and the Y curve, also 4" order polynomials exhibit acceptable behavior to follow the real shape of the exercise A. 


The same procedure has been applied to the other three rehabilitation exercises. In exercise B, the first m<1 has been 
found in scanning 4. The eXYP exhibits marked decrease until scanning #4 corresponding to 4" order polynomials for 
both X and Y data. These polynomials provide a curve acceptable regarding demonstrations, Fig. 6. In exercise C, the 
first m<1 has been found in scanning 3. The eXYP exhibits marked decrease until scanning #3 corresponding to 3 order 
polynomials for both X and Y data, obtaining the curve (X, Y) observed in Fig. 7. Fourth order polynomials have been 
also selected for exercise D. The selection has been also made according to the decrease of the eXYP curve with the first 
m<l in scanning 4, obtaining the curve of Fig. 8 for X and Y data. 


Normalized eXYP 
100 —+ | 






e Selected eXYP=0.635522 corresponding 
50 to scanning 4 (m<1.0), for the selected 
permutation polynomial M=4, N=4 





0 2 ME PIS “ao 12 44 16 18 ~~, 
e. 0 # Scanning 


Fig. 4 eXYP curve - exercise A 
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Fig. 5 Generated curve for the exercise A in the Y and X axis with 4'” order polynomials 
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Fig. 6 Generated curve for the exercise B in the Y and X axis from 4" order polynomials 
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Fig. 7 Generated curve for the exercise C in the Y and X axis from 3™ order polynomials 
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Fig. 8 Generated curve for the exercise D in the Y and X axis from 4" order polynomials 
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The generated curves fit successfully to the real shape of the knee exercises. Polynomials varied between the third 
and fourth order; fourth order for exercises A, B and D, which describe curves formed by the rotation of the hip or curves 
formed by the combined rotation of the knee and hip; third order polynomial were selected for exercise C which 
described trajectories less bend than the other exercises. 


The device could reproduce the reference trajectory by using the average of the velocities and accelerations of all the 
stored trajectories or by using velocities and accelerations into a range selected by the therapist. 


IV. SELECTING THE ONE OF THE DEMONSTRATED TRAJECTORIES 


The generated reference curves by regression can be reproduced by the device since it represents the entire set of 
stored trajectories. However, in order to offer a second option to the therapist, the stored trajectory that best fit all the 
trajectories has been selected by using as reference points the curve generated by polynomials. Thus, the trajectory has 
been chosen by evaluating the same error eXY, (Eq. 3) calculated in the section 3. 


Figs. 9, 10, 11 and 13 show the selected demonstrations versus the generated curves (x,y) for exercises A, B, C and D. 
As it can be seen observed in the figures, the selected demonstrations for exercises A, B, C and D are nearest to the 


generated curve and represent successfully the shape of the knee exercises. 


The knee assistive device could reproduce the selected demonstrations with the same velocities and accelerations or 
by using velocities and accelerations into the ranges selected by the therapist. 
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Fig. 9 Trajectory selected for X, Y axes, exercise A 
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Fig. 10 Trajectory selected for X, Y axes, exercise B 
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Fig. 11 Trajectory selected for X, Y axes, exercise C 
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The demonstration nearest to the curve generated by the polynomials represents the entire set of demonstrations; the 
selection provides a known trajectory for patients who can only execute one of their own trajectories due to the severity 
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Fig. 12 Trajectory selected for X, Y axes, exercise D 


of their injury or illness. 


In this paper a method to generate reference trajectories for a knee assistive device is proposed. The method 
successfully generates a reference trajectory, through regression analysis, by using a set of trajectories demonstrated on 


the assistive device. 


The method is able to follow the shape of the proposed knee exercises, selecting effectively the order of the 
polynomials that provide a better fit to the real shape of the trajectories. The procedure to applied the method consists of 
four steps: 1) The patient performs the exercise on the assistive device while the therapist guides the movement and the 
device stores a set of trajectories; 2) a reference trajectory is generated by using the proposed method for curve 
generation; 3) One among all the demonstrated trajectories is selected by using the error behavior; 4) the assistive device 
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V. CONCLUSIONS 


reproduces the generated reference trajectory or the selected trajectory. 
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The reference trajectories generated by the method can be reproduced by using velocities and acceleration from the 


demonstrations or by using commercial ranges. As future work the device could have an adaptive control to take into 
account the strength when reference trajectories are reproduced. 


Acknowledgments Authors thank to CRIQ specialists for their help in the selection of exercises for knee rehabilitation. 


REFERENCES 


H. Hung-Jung and C. Tien-Chi, Motorized CPM/CAM physiotherapy device with sliding-mode Fuzzy 
Neural Network control loop. Elsevier: Computer Methods and programs in biomedicine 96, p 96-107, 
2009. 

J. Weiner. Device and method for knee joint rehabilitation, Patent No US 7,695,416 B2. United States 
Patent, 2010. 

T. Nef and R. Riener. ARMin-Design of a Novel Arm Rehabilitation Robot. Proceedings of the 2005 
IEEE, 9th International Conference on Rehabilitation Robotics,June 28-July 1, IL, USA, 2005. 

E. Akdogan and M. Arif, The design and control of a therapeutic exercise robot for lower limb 
rehabilitaion :Physiotherabot. Elsevier. Mechatronics 21 (2011) 509-522, 2011. 

A. Billard, S. Calinon, R. Dillmann, and S. Schaal, Robot programming by demonstration, in Handbook 
of Robotics. B. Siciliano and O.Khatib Eds. Secaucus, NJ: Springer-Verlag, pp. 1371-1394, 2008. 

X. Wenkang, C. Bing and E. Rogers, Cascade based Iterative Learning Control of Robot-assisted Upper 
Extremity Stroke Rehabilitation. IEEE Conference on Decision and Control, Italy, December 10-13, 2013. 
L. Renquan, L. Zhijun , S. Chun-Y1 and X. Anke, Development and Learning Control of a Human Limb 
with a Rehabilitation Exoskeleton. IEEE Transactions on Industrial Electronics, Vol. 61, NO. 7, July 
2014. 

S. Calinon, F. Guenter and A. Billard, On learning, representing and generalizing a task in a humanoid 
robot. IEEE Trans. Syst.,Man, Cybern., Part B, vol. 37, no. 2, pp. 286—298, Apr. 2007. 

S. P. Chatzis, D. Korkinof and Y. Demiris, A Quantum-Statistical Approach Toward Robot Learning by 
demonstration. IEEE Transactions on Robotics, Vol. 28, NO. 6. December 2012. 

B. D. M. Chaparro-Rico and E. Castillo-Castañeda, Tesis: “Dispositivo para la Rehabilitación de la 
Rodilla Basado en un Mecanismo Paralelo”, Instituto Politécnico Nacional-CICATA-Qro. 2014. 


. C. M. Bishop. Pattern Recognition and Machine Learning, Springer, Singapure. 738 p, 2006. 


S. Vijayakumar and S. Schaal, Locally Weighted Projection Regression: An On Algorithm for 
Incremental Real Time Learning in High Dimensional Spaces, Proc. International Conference on Machine 
Learning (ICML) pp. 288-293, 2000. 

S. Calinon, F. D’halluin, E. Sauser, D. Caldwell, and A. Billard, Learning and reproduction of gestures by 
imitation: An approach based on hidden Markov model and Gaussian mixture regression, IEEE Robot, 
Autom. Mag., vol. 17, no. 2, pp. 44-54, Jun. 2010. 

W. Yan, S. Yanyu and Y. Demiris, A morphable template framework for robot learning by demonstration: 
Integrating one-shot and incremental learning approaches. Elsevier:Roinversebotics and Autonomous 
Systems 62, p1517-1530, 2014. 


191 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 20, páginas 192 - 199. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


Propuesta de un robot móvil 
para la detección de fuentes radioactivas 


A. De la Barrera Gonzalez.', E. G. Hernández Martínez.*, J. V. Cervantes Bazan.?, J. A. 


4 
Monterrubio Suarez. 


Resumen— En este reporte de investigación se presenta una propuesta para el diseño y desarrollo de un robot 
móvil terrestre, programado para realizar inspección, registro y una recolección de materiales radiactivos en el 
campo, ya que estas actividades suponen un alto riesgo para la salud humana; este robot móvil tiene tracción en las 
cuatro ruedas, es tele dirigido en una banda de frecuencia exclusiva de X-bee, cuenta con transmisión de vídeo en 
tiempo real en una frecuencia específica, se obtiene una ubicación del móvil con las coordenadas geográficas 
mediante GPS, así como se conoce la orientación geográfica del movimiento del robot mediante una brújula 
electrónica, contiene un reloj de tiempo real para conocer el momento en que se detecta la fuente radiactiva y por 
supuesto tiene un detector de rayos gamma; la información obtenida por cada módulo en el robot es recopilada por 
un microcontrolador AVR que se ha programado usando la plataforma Arduino y se transmite utilizando un 
módulo de X-Bee. El receptor desmodula la información y la entrega en formato digital utilizando otro módulo X- 
Bee, esta información también es administrado por un Arduino, se visualiza en una pantalla LCD y se almacena en 
una computadora personal a través de la comunicación USB, el vídeo recibido se presenta en una monitor de vídeo, 
la dirección de desplazamiento es manipulada por una palanca de mando que es operado por el Arduino. 


Palabras clave-- Robot, Arduino, Radiación, Geiger Muller, GPS, telemetría, teledirigido. 


I. INTRODUCCIÓN 


E | prototipo de robot móvil presentado en este reporte de investigación, tiene por finalidad inspeccionar 
el entorno, recolectar y enviar, información sobre actividad radioactiva mediante RF, con la cual se puede 

determinar si existe una fuente que produzca rayos gamma con la utilización de un contador Geiger 
Muller y con la finalidad de no exponer al ser humano e estas radiaciones debido a estas tareas. La telemetría 
es una de las tecnologías más importantes en la actualidad, cuando se trata de medir variables físicas, tales 
como; temperatura, humedad, tensión, intensidad eléctrica, ubicación geográfica, entre otras. Es importante 
conocer las condiciones del lugar donde se encuentre localizado el robot, para lo cual, se le implementó un 
sistema de visión con envío de señales al receptor de telemando; se le implementaron controles para dirigir el 
avance y dirección del robot enviados por radio control; contiene un módulo GPS para obtener la localización 
geográfica donde se ubique el robot y por lo tanto la probable ubicación de la fuente radioactiva; contiene 
una brújula electrónica para conocer la orientación y dirección de desplazamiento del robot. Con la finalidad 
de poder recolectar la fuente de radiación se le implementó un pequeño brazo robótico tele controlada para 
poder colocar o transportar la muestra a un contenedor apropiadamente protegido. 


Il. ANTECEDENTES 


Por muchos años el hombre, vestido y equipado de forma especial y por su propio pie ha detectado fuentes 
radioactivas cuando se sabe que existen, pero cuando no lo sabe se expone a las dañinas y posiblemente 
mortales radiaciones de fuentes radioactivas. Con la finalidad de no exponer al ser humano a estas fuentes se 
propone el desarrollo y uso de un robot móvil que posea el instrumental necesario para detectar y enviar una 
alarma o mensaje de advertencia al usuario, el robot que se propone es teledirigido para que le permita al 
usuario manipularlo para detectar fuentes radioactivas que puedan generar partículas alfa, beta y gama. 
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Los robots móviles son mecanismos que contienen extremidades de cualquier tipo conocido, en este caso 


son ruedas de goma las cuales son capaces de producir fricción con el suelo, para así lograr desplazarse de un 
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lugar a otro siendo manipulados o programados por un usuario, para seguir una trayectoria programada de 
forma rutinaria o controlada por un usuario. 

Los robots se han construido para sustituir al ser humano en tareas repetitivas dentro de algún sector laboral 
y en ambientes hostiles o riesgosos. En [1] y [2] se habla sobre un robot el cual es capaz de reorganizar 
varias cosas de entre un desordenamiento, se explora el problema de planificación de reordenamiento, donde 
un robot debe reorganizar varios objetos para que finalmente queden en la posición original se han utilizado 
modelos físicos simples, como cuasiestático inducido, para producir rápidamente planes intrínsecos eficientes 
de la ruta a seguir. Sin embargo, la complejidad de estos planes los hace particularmente sensibles a la 
incertidumbre del objeto a representar, los parámetros de la física, y la ejecución de una trayectoria. La 
robótica es una tecnología relativamente moderna en cuanto a su automatización mediante circuitos 
miniaturizados; la comprensión del funcionamiento y diseño de la robótica fija o móvil requiere del 
conocimiento de áreas de la ciencia y tecnología principalmente de ingeniería eléctrica, mecánica, electrónica 
de control y de sistemas computacionales, como se menciona en [3]. En [4], se habla de los efectos que tiene 
el robot cuando realiza tareas de manera autónoma y cuando las realiza de forma manipulada por un ser 
humano, pudiéndose entender el estudio independiente de estos movimientos o el estado colaborativo entre 
humanos y robots. Se puede hacer que un robot trace su camino de desplazamiento y determinar su ubicación 
geográfica mediante GPS, como se menciona en [5], en este trabajo, se explora el uso de objetos que pudieran 
colisionar. Mediante la utilización de láser para la ubicación de estos objetos se obtiene una ubicación precisa 
de los objetos y se traza una trayectoria de desplazamiento esquivando dichos objetos, como se menciona en 
[6]. Un sistema de telemetría consiste de uno o varios sensores o transductores de variables físicas que 
actúan como dispositivos de entrada, un medio de transmisión guiado o mediante radio frecuencia, 
procesamiento de estas señales, dispositivos remotos de grabación o visualización de los datos medidos 


HI. DESARROLLO 


En la figura 1A, se presenta el diagrama a bloques de los módulos de los que está compuesto el robot 
móvil, indicando cada uno de ellos. Como dispositivo de control y adquisición de datos se utilizó una tarjeta 
Arduino UNO, la cual mediante un programa recaba las variables desde el dispositivo GPS que proporciona 
las coordenadas geográficas de ubicación terrestre del robot; la brújula electrónica indica la dirección de 
desplazamiento; el RTC es un reloj de tiempo real que indica la hora y fecha real en la que se pueda detectar 
una fuente radioactiva la cual es detectada por un contador Geiger Müller, la tarjeta controladora de los cuatro 
motores para la tracción independiente de cada rueda, como medio de comunicación de radio frecuencia se 
utilizó un módulo X-Bee, en configuración half dúplex para dirigir la desplazamiento del robot móvil 
terrestre; la brújula electrónica indica la dirección de desplazamiento; el RTC es un reloj de tiempo real que 
indica la hora y fecha real en la que se pueda detectar una fuente radioactiva la cual es detectada por un 
contador Geiger Müller. La tarjeta controladora maneja los cuatro motores para la tracción independiente de 
cada rueda; como medio de comunicación entre el usuario y el robot móvil para el mando a distancia se 
utilizó radio frecuencia mediante un módulo X-Bee, en configuración half dúplex. 

En la figura 1B, se presenta un diagrama de bloques del receptor, que está compuesto por un módulo X-Bee 
que entrega datos digitales a una tarjeta Arduino UNO para presentarlos en un display tipo LCD de 4 líneas y 
20 caracteres y que, opcionalmente se pueden enviar a una PC mediante una interface USB, construida en el 
Arduino, también desde este módulo se envían al robot los comandos de desplazamiento utilizando un 
joystick y codificando el desplazamiento se envía al robot móvil mediante el radio modem X-Bee. 

Para el diseño del robot móvil se utilizó una placa rectangular de PVC de 0.55x0.46m, donde se instalaron 
los cuatro motores, cada uno con una rueda de neopreno, para lograr una mayor fuerza de tracción y 
estabilidad en superficies planas y difíciles, estas ruedas están acopladas de manera que el vehículo pueda 
desplazarse en terrenos tales como asfalto, concreto, césped y algunas partes rugosas como terracería o 
escombros de construcción. El diseño rectangular de la plataforma, permite una mejor distribución del peso 
que lleva consigo, como son baterías, tarjetas controladoras de motores, sistema de visión FPV, blindaje de 
lámina de plomo de 500 gramos para circuiterías y la instrumentación de detección de radiación gamma. 
Cada una de los partes y módulos utilizados se describen a continuación: 

1.- Sintra de PVC. Es una placa de PVC espumoso de 0.46x0.55m, resistente a altas temperaturas del 
ambiente, a golpes y a la humedad; es utilizada como soporte para toda la instrumentación electrónica, 
instrumentos de medición y en la que se montan los 4 motores que dan tracción al robot móvil. 

2.- Arduino, como se menciona en [8] y [9] es una plataforma de desarrollo que incluye un microcontrolador 
como hardware y un lenguaje de programación; con ella se pueden realizar diversos proyectos sin necesidad 
de licencia para su uso, para el robot móvil se utilizó un módulo Arduino UNO, como se muestra en la 
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figura 2A, para la adquisición de datos digitales en el robot móvil y la recepción e interpretación de 
comandos de desplazamiento del móvil desde el comando del usuario. En la parte del receptor también se 
utilizó un Arduino UNO, para la recepción y presentación de los datos de telemetría en un display de LCD; 
se utilizó un Arduino MEGA, mostrado en la figura 2B, para el control de desplazamiento con joystick. 





Display de 
LOD 





Ardino 





A) B) 


Fig. 1 Diagramas a bloques A) del robot móvil y B) del telecontrol, receptor de telemetría y recepción de video. 





A) B) 
Fig. 2 Tarjetas de desarrollo A) Arduino UNO y B) Arduino MEGA. 


3.- Motor con reductor EMG49. Es un motor de corriente directa (CD) el cual se muestra en la figura 3A, con 
una alimentación de 24 volts desarrolla una velocidad de 122 rpm, con un torque de 16 kg/cm, ya que 
contiene un sistema de engranes reductor de 49:1 [10]. En el interior del motor se encuentran acoplados dos 
sensores de efecto hall, los cuales conforman un encoder, estos sensores producen 588 pulsos por 
revolución del rotor, con la cuenta de estos puñsos se puede conocer con precisión el desplazamiento del 
móvil. 

4.- Tarjeta controladora de motores MD49. Es una tarjeta controladora diseñada para manejar 2 motores de 
CD se alimenta con 24 volts, cuenta con selectores tipo jumper para seleccionar la velocidad de transmisión 
de datos ya sea a 9,600 o 38,400 bits/segundo, contando también con los conectores para las entradas de los 
encoders de los motores, la cual se muestra en la figura 3B, como se detalla en [11]. 

5.- Reloj en tiempo real. (RTC por sus siglas en inglés) que se presenta en la figura 4A, es un dispositivo 
electrónico el cuál proporciona la fecha y hora con precisión. Con este componente, el móvil será capaz de 
especificar la hora y fecha de la detección de la fuente radioactiva, como se indica en [12] y [13]. 

6.- Modulo GPS, NEO-6 U-BLOX. Es un dispositivo electrónico el cual a través de satélites geoestacionarios 
obtiene la ubicación en tiempo real del móvil, entregando como resultado parámetros tales como: latitud, 
longitud y altitud, este módulo electrónico se muestra en la figura 4A, y funciona como se indica en [14]. 

7.- Brújula magnética electrónica CMPS10. Es un dispositivo electrónico el cual cuenta con un magnetómetro 
que se alinea con el norte magnético terrestre. Este dispositivo se comunica mediante el protocolo I2C. Es 


194 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 20, páginas 192 - 199. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


capaz de obtener la orientación que adquiere el robot en cualquier instante de tiempo, dicho componente se 


ilustra en la figura 5A, y funciona como se indica en [15]. 
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A) B) 


Fig. 3 A) Motor con reductor EMG49. B) Tarjeta MD49, controladora de motores de C.D 





A) B) 


Figura 4. A) Tarjeta Tiny RTC, reloj de tiempo real, y B) Modulo GPS NEO 6 U-BLOX 


8.- Joystick analógico. Es un dispositivo electrónico que contiene dos potenciómetros, uno para el eje de las 
abscisas y otro para el eje de las ordenadas; con este dispositivo se hace la manipulación del avance del 
robot para indicarle en qué dirección se debe de desplazar, se muestra en la figura 5B, como se detalla en 


[18] y [19]. 





A) B) 


Figura 5. A) Brújula magnética y B) Joystick analógico de dos ejes (X y Y). 
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9.- Detector Geiger Miller, Tipo GQ GMC-320 Plus. Es un instrumento de medición de rayos alpha, beta y 
gamma. El detector en su interior contiene un hilo conductor el cual actúa como el ánodo y la pared del 
dispositivo actúa como el cátodo. Además, en la parte interna del dispositivo contiene gas Argón, que al 
entrar en contacto con alguna partícula del haz de radiación ioniza el gas y desprende un electrón del Argon 
lo cual provoca un flujo de corriente que causa una avalancha de pulsos eléctricos detectables, como se 
muestra en la figura 6, se describe detalladamente en [16] y [17]. 

10.- Telemetría. Es una técnica de las comunicaciones que cuantifica y envía a larga distancia información 
sobre variables físicas. El dispositivo que se utiliza para la transmisión RF es el módulo de radio modem X- 
BEE PRO S3 de largo alcance, como se muestra en la figura 7A, Zigbee es un protocolo de comunicaciones 
inalámbrico basado en el estándar de comunicaciones para redes inalámbricas IEEE 802.15.4. Opera a una 
frecuencia de 2.4 GHZ con una velocidad inicial de transmisión de 3600 baudios/segundo. Cuenta con 8 
canales digitales de transmisión de datos, como se detalla en [20]. El X-Bee convencional va montado a un 
adaptador como se muestra en la figura 7B. Estos radio módems pueden ser administrados por el programa 
XCTU, que fue desarrollado por la compañía Digi International, para configurar el modulo X-BEE se 
cuenta también con un monitor serial para enviar y recibir datos de algún otro modulo X-Bee con el que se 
encuentre enlazado. 





A) B) 


Figura 7. Módulo radio módem A) X-Bee PRO S3B, de largo alcance y B) base USB para radio modem X-Bee 


11.- Sistema de Primera Visión de Vuelo (FPV), es una tecnología propia a los drones, pero se utiliza el 
mismo principio en el robot móvil, para que a larga distancia el usuario pueda observar las condiciones del 
lugar por las que el móvil realiza su desplazamiento de un lugar a otro. Los elementos que conforman un 
sistema FPV son: sensor de video como el mostrado en la figura 10, Transmisor, Antena, Receptor y 
Sistema de visualización. 

La transmisión de audio y video con el sistema de visión FPV utiliza una frecuencia de transmisión de 5.8 
GHz. La cámara utilizada se muestra en la figura 8, es de modelo CCTV-131 con un sensor de Semiconductor 
de Óxido de Metal Complementario (CMOS), con una resolución de 762 x 504 pixeles las imágenes se 
muestran con claridad, se utiliza la transmisión de video bajo el estándar NTSC (National Television Systems 
Committee, NTSC), y cuenta con un ángulo visual de 72°. 
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En la figura 9 se muestra el interior del gabinete del control remoto para desplazamiento del robot, donde se 
aprecia la tarjeta Arduino Mega, el módulo del Joystick, el módem X-Bee con su respectiva antena y una 
batería LIPO de 7.4 volts con capacidad de 1500 mAh. 

Para la telemetría se instalaron dos módulos X-Bee de largo alcance, estos dispositivos son Half-duplex, ya 
que pueden funcionar tanto como transmisor o receptor pero en solo un momento dado y posteriormente 
intercambiar la función, de acuerdo al requerimiento programado. 


area, 





Figura 8. Cámara CCTV-131 


Básicamente existen tres formas de presentar los datos de la telemetría: 
1. Mediante el monitor de datos del XCTU, utilizando una computadora tipo PC. 
2. Mediante monitor serial de Arduino. 
3. Mediante un display alfanumérico de LCD. 





Figura 9. Componentes que conforman el control del robot móvil. 


En el monitor serial del XCTU se observó que después de cierto tiempo de estar mostrando los datos de 
telemetría, este se suspendía y la pantalla no seguía actualizando los datos. Razón por la cual se procedió a 
realizar un programa en la tarjeta Arduino que mediante su monitor serial mostrará los datos de telemetría en 
una computadora PC, con lo que se corrigio la actualización de los datos. 

Para mostrar los datos de telemetría en una LCD, es necesario declarar otro puerto serial adicional en la 
placa Arduino con la librería SoftwareSerial. Con el uso de otra librería propia de Arduino llamada 
LiquidCrystal, con ella se pueden declarar los pines de Arduino que están conectados en los pines de display 
LCD 20x4, los pines de Arduino deben ser de salidas digitales. Por lo que con la utilización del dispaly de 
LCD es mucho más fácil recibir los datos de telemetría. La telemetría se envía mediante RF a 2.4 GHz a 
través de un módulo X-Bee. Para la parte de control e interpretación se utiliza un Arduino mega 2560, esta 
tarjeta cuenta con más pines tanto digitales como analógicos que los de la tarjeta Arduino Uno, como también 
cuenta con tres puertos seriales diseñados para la comunicación con otros dispositivos. 

En la figura 10A, se muestra un segmento de código de programa para Arduino, la declaración de las 
diferentes librerías que se utilizarán para cada dispositivo utilizado, así como también, la declaración de 
variables de entrada, salida y variables para almacenamiento de datos. En la función setup(), de la figura 10, 
se inicializan las diferentes librerías que se declararon previamente. En el caso de la comunicación serial, se 
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inicializa el puerto serial a una velocidad de transmisión de datos de 9600 bits/segundo. El cuerpo del código 
se elaboró mediante funciones. Con este método de programación, en cualquier momento se pueden llamar 
desde una función principal, esto solo en la función loop(), pues lo que se encuentre programado en este 
apartado se repetirá de forma indefinida, es decir, es un ciclo repetitivo del programa, de acuerdo a las 
condiciones establecidas por el programador. 

En la figura 10B se muestra el prototipo terminado el cual funciona de acuerdo a las características 
especificadas, el desplazamiento, la recepción de audio y video; así como las coordenadas geográficas y 
orientación del robot. 


Archivo Editar Sketch Herramientas Ayuda 











Telemetr_a 
#include <Tiny6P5.h> į} Librería para GPS, 
#include <Liquidfrystal, b> /} Libreria para la Led, 
#include <Nire,h> // Libreria para Bus 120, 
#include <Softwareserial.h> // Libreria para declarar otros pines 
#include <SoftwareSerial.h>  // Libreria para declarar otros pines 
#define led 13 
TinyGPS gps; // crear un objeto de TinyGP5, 
#define ADDRESS 0x60 ¿/ Definir la dirección de CMPS10, 
SoftwareSerial compas(5, 4); // Pines para Serial port, 
softwareserial 33(2, 3); // Pines para serial port, 
LiquidCrystal led(12, 11, 5, 4,3, 2); // Pines del Arduino para la 
byte highbyte, lowByte; // Declaración de variables tipo (b 
char pitch, roll; // Declaración de variables tipo (c 
float yaw; // Variable para quardar angulo yan 
float y; // Variable para quardar decimales 


void setup () 


{ 
Serial. begin(9600) ; // Imicializacion del puerto serial 
ss. begin(9600); ¿7 Inicialización del puerto serial 3 
pinfiode (led, OUTPUT); // Declaración del pin 13 como salida 
digitallrite(led, LOW); ¿7 Dejar en nivel bajo al pin led, 
Wire. begin(); // Conectar con 12€ 
compas. begin (9600) ; // Inigializar el puerto serial compas 
Ied.begin(20, 4); // Inicializar la led de 20x4, 


A) B) 


Figura 10. A) Declaracion de librerias de algunos dispositivos. B) Prototipo funcional terminado 


IV. PRUEBAS Y RESULTADOS 


Las pruebas del desplazamiento a control remoto del robot móvil se efectuaron en distintos sitios, se probó 
el funcionamiento en un laboratorio sobre piso de concreto, en dichas pruebas los comandos se ejecutaron 
apropiadamente. 

Las pruebas de campo del sistema de visión (FPV) se realizan sobre asfalto. Esta prueba permitió controlar 
al robot móvil hasta una distancia de 400 metros. Con la cámara de video que se le instaló al robot móvil en la 
parte frontal, se recibió audio y video el cual con excelente claridad. Las pruebas de funcionamiento del 
módulo X-Bee que es transmisor en el robot se pudieron leer en el display de LCD, la ubicación, orientación, 
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tiempo real y contador de rayos gamma; y opcionalmente también se mostraron en una computadora Laptop 
Dell Inspirion 1420, utilizando el programa XCTU. La comunicación entre los radio módems X-BEE y la 
computadora se estableció satisfactoriamente. 
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Towards an adaptable human-machine interface for autonomous 
visual navigation for UAV in unstructured environments 


r 1 r ° Y 2 
Cesar Omar Orozco Lopez , José Gabriel Ramírez Torres 


Abstract— In this work we present the first of two stages of development of a new Human-Machine Interface (HMD, adaptable 
to the context of current task for an Unmanned Aerial Vehicle (UAV) and operator’s skills. This first stage consists on the 
implementation of a Three Layered Architecture (TLA) able to add, activate and deactivate reusable software components called 
skills or behaviors. The TILA and the skills are implemented on Robot Operating System (ROS) within the microprocessor onboard 
the UAV. The skills are added to the TLA using an abstract base class that allows to easily integrating the software components 
through a control mechanism. The skills, as well as their parameters and outputs must be registered in a skills library. The second 
stage, will involve the HMI design with an adaptive approach: its main objective will be balancing the information shown to the 
operator, according with the activated skills on the TLA as part of the UAV mission. The goal of this approach is the reduction of 
the human operators’ workload, and therefore, the number of accidents caused by human factors, such as the operator workload 
and the ergonomic design of the HMI. This paper focuses on the TLA development, and it contributes with one of the first attempts 
of its implementation using ROS on a UAV quadcopter. The preliminary results of first stage of development with the workload 
measurements on novice operators using teleoperation-based HMI has been included. 


I. INTRODUCTION 


Unmanned Aerial Vehicles (UAV) are defined as aircrafts without the onboard presence of pilots [1]. The UAVs are being 
used on a growing number of applications in the last decade, with potential usage in the civil UAV market in the next four 
years [2]. The new technological advances on electromechanical devices allowed the development of the UAV for commercial 
purpose with a reduced weight and size. These UAVs have been designed for different applications such as: search and rescue, 
fire combat, crop monitoring, border line monitoring, to mention a few. 


The continued growth of use of these devices has produced a bigger interaction between the human and the UAV. The 
interaction has place if there is a Human-Machine Interface (HMI), which is used to exchange information between the 
operator and the UAV via a wireless channel. The operator sends navigation commands to modify the internal state of the 
UAV and the vehicle sends information related with the flight plan through the channel. The information received from the 
UAV is provided to the operator in the HMI. A Ground Control Station, the wireless channel, the operator, the UAV and the 
HMI are components of a bigger system known as Unmanned Aerial System (UAS). 


The HMI has an important role at the UAS because is the only tool available for interaction between the operator and the 
UAV. The efforts to resolve issues related with the HMI have been scarce given how the research have been focused on the 
problems of automation and interoperability [3]. A critical aspect to keep in mind is the HMI design: if there is information 
overload or information underload, the HMI design could be the cause of risk situations for the UAS. Moreover, if the 
information displayed in the HMI is not clear the operator could be la cause of accidents, such those registered by the U.S. 
Army and Air Force from 1985 to 2002 [4]. The Figure 1 shows the number of accidents associated with an UAV compared 
with a manned aircraft. 


Figure 1. Relation of accidents with differents classes of unmanned and manned aircrafts, image taken from [4]. 
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The U.S. Army has identified the main causal factors of accidents as: material factor, environmental factors and human factor 
[5]. 


e Material Factor: Includes equipment failure and damage that can result from design flaws, component or system 
failure. 


e Environmental factor: Includes noise, illumination and weather conditions which can adversely affect the 
performance of the operator or the equipment. 


e Human factor: Related with the human errors, which are mainly inherent to human design, function and behavior. 


The human causal factor 1s the most cited at the accidents related with the unmanned systems. Some studies have described 
this causal factor between ranges from 60% to 80%, especially with the UAV Predator [6, 7]. The human causal factor includes 
six classes of human errors: operator workload, situation awareness, crew coordination, fatigue, ergonomic design and training. 


The operator workload is defined as the combination of task demands or load factors, and an operator’s response to those 
demands [8]. The operator is exposed to high levels of workload if at least two conditions are presents during the flight plan: 1) 
the operator is fully responsible of the flight without any automation processes and agents for decision taking; 2) the flight is 
taking place at a non-structured low altitude environment. An operator perceives a higher level of workload at the low altitude 
environments due to the dynamic nature of the environment. Ergonomics has established that the humans have limitations to 
process all the information generated by UAV flights. Although the rest of the causal factors also have importance, the 
operator workload and the ergonomic design are directly related with the operator and the HMI. Those factors impose changes 
not only on the flight plans at low altitude environments, but also they impose changes on the HMI design. An HMI adaptive 
approach is desired to minimize the accidents related with workload and increase the operator’s efficiency. Breant A. 
Terwilliger et al. in their work “Advancement and Application of Unmanned Aerial System Human-Machine-Interface (HMI) 
Technology” [3] refer to the last two problems as “the lack of the optimized information” and the “lack of adaptability and 
flexibility” for effective HMI designs. 


In this work we propose the development of a new adaptable HMI using the emergent mobile devices. This project is 
divided on two stages: the first one consists on the implementation of a Three Layer Architecture (TLA) implemented on ROS, 
for easy reuse of developed software components. The second stage, at present in progress, consists of the development of 
HMI with an adaptive approach to balance the information displayed to the operator of the skills activated by the sequencing 
layer on the TLA. This paper contributes with one of the first attempts of implementing a TLA on the UAV fields. The 
expectation for the second stage is to contribute with an effort on the HMI for UAVs, minimizing the human operators’ 
workload during the UAV flight on non-structured environments reducing the accidents related with human factors and 
provide an adequate way of data presentation for making decision. 


This paper is organized as follows. Section II provides concepts and background for this document. Also, it introduces the 
NASA-TLX instrument, which is used to calculate the operator's workload in this work. Section III introduces the proposed 
approach, the required infrastructure and the methods for the TLA implementation. Section IV presents the results of the 
execution of the TLA and validates the feasibility to implement the adaptive HMI. Next, the preliminary results of evaluating 
the operator workload using a traditional teleoperation-based HMI are included. Finally, Section VI presents the conclusions 
and the future directions for this work. 


II. BACKGROUND 


This section describes basic concepts related with this research, such as: TLA, techniques for operator workload 
measurements and a description of ROS and the mavros package. The TLA was firstly introduced by Firsby [9] as a 
functional layout for reactive-deliberative robots. The basic design proposed by E. Gat is followed, which is based on the 
Firby’s architecture. There are different methods to collect information about the operator workload. This section includes the 
different types of workload measurements and a list of criteria which allows choosing the correct method to get this measure. 
ROS is described in order to understand how its features make it a convenient tool to implement the TLA. 


A. Three layer architecture 


The TLA is widely used on mobile robots and is represented by three modules or components (see Figure 2). Its purpose is 
to organize the functionality of the robot according to the time required by the algorithms (skills or behaviors) to finish their 
tasks. The organization is realized according to whether the algorithms has an internal state, contains state reflecting memories 
about the past, or contains a state reflecting prediction about the future. E. Gat on his work “On Three Layer Architecture.” 
refers to each module as layers and they are: 1) deliberation layer, 2) sequencer layer and 3) controller layer. The layers 
described by E. Gat are known also as planning layer, sequencing layer and skill layer [10]. 


The planning layer is a container of algorithms that consume a long time to compute information to be used in the future. 
Usually the planning layer contains modules such as search-based and vision algorithms. It’s usually considered as a 
deliberative planning capability that reasons in depth about goals, resource and timing constraints [11]. The algorithms 
allocated in this layer make a data projection to use the information in the future. The planning layer builds the plans to be sent 
to the sequencing layer. 
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The sequencing layer is the one in charge to activate and deactivate skills while providing their parameters. An important 
feature of the sequencer is to not perform computations that take a long time, like any search or temporal projection. The 
activated skill modifies the work and the internal state to reach the targets established by the planning layer. 


The skill layer is a dynamically reprogrammable set of reactive skills [11]. It consists of one or more computation threads 
that implement one or more feedback control loops [10]. This layer usually contains a library of functions called skills or 
primitive behaviors which are activated at any time by the sequencer or by an external input to this layer. Some examples of 
primitive behavior are: wall following, moving to a destination and follow target among others. 


Figure 2. The Three Layer Architecure model proposed by E.Gat, based on Firby’s architecture. 


Deliberation 






Sensor reading Actuator commands 


World/Environment 


B. Robot operating system (ROS) 


ROS, the open-source robot operating system is not an operating system in traditional sense of process management and 
scheduling. Instead of operating system, rather 1t is a framework that provides communication layers using a host operating 
system [12]. ROS 1s a framework to develop robotics applications widely used since 2007. Its features (peer-to-peer, 
multilingual, free and open-source, tool based and others) allow to developers write applications and run them in a short time 
using a set of ROS libraries or reusing code shared from others developers. The main aim of ROS is to allow the reuse of 
robotic software across the globe [13]. In fact, a piece of software made on ROS can be easily used in a different robot with 
small changes in its code [14, 15]. 


ROS supports different programming languages and even though C/C++, Lisp and Python are the main client libraries 
supported, a wide list of experimental clients are available [16]. The support of multiple programming languages allows 
developers to easily write code without the constraint of selecting a specific programming language. 


The robotic applications are developed using a number of independent execution programs known as nodes. The nodes 
communicate with each other by publishing messages to topics (publish/subscribe messaging model). For example, a particular 
sensor driver could be implemented as a node, which publishes sensor data as a streaming message. The message can be sent 
using communication channels on ROS, called topics, and consumed by any other number of nodes, including higher-level 
systems. 


ROS organizes the software in packages that can contain different components like: nodes, datasets, configuration files, or 
any useful module. A robotic application developed on this framework is a custom user package for specific purpose. A 
package might use packages available in the repositories, e.g. mavros, mavros_ extras and mavros msgs are packages that 
provide the message, topics and communication node for ROS with GCS and small unmanned vehicles. The mavros package 
uses the MAVLink protocol, a header-only message marshaling library for micro air vehicles. Despite ROS does not perform 
in real time it has been successful in the industry with the most popular platform using ROS: Aldebaran Nao [17]. ROS is also 
successful in the commercial market, and academic areas with at least 2724 mentions. 


C. Workload measurement with NASA-TLX 


The workload represents the cost of accomplishing mission requirements for the human operator [18]. If the operators have 
a high resource demand and the human cost of maintaining performance is unacceptable, the operator workload during the 
design and system operation must be evaluated. Miller provides three main classifications to measure the operator workload 
[19]: 
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e Performance measurements 
e Physiological measurements 
e Subjective measurements 


The performance-based methods provide two ways to measure the operator workload: 1) the primary task which it is based 
on the capability to perform a main task and, 2) the secondary task to measure the difference between mental capacity and total 
mental capacity. The physiological measurements use the human body reaction to get objective measurements. Usually require 
specialized equipment such as electroencephalograms and cardiac monitors. The subjective measurements are considered the 
simplest method to collect information of the operator workload. Usually this method uses questionnaires filled directly by the 
operator. This method is not accurate; however, it is widely used by its low cost and simplicity. In order to select a correct 
method to measure the operator workload, Kennet Boff et al. suggest consider the sensitivity, diagnosticity, intrusiveness, 
implementation requirements and the operator acceptance [20]. 


The NASA-Task Load Index (NASA-TLX or just TLX) is a subjective method to evaluate the operator workload (see 
Figure 3) [21]. It was developed by the Human Performance Group at NASA's Ames Research Center. This method consists of 
a questionnaire with six subscales that represent independent clusters of variables: Mental Demand (MD), Physical Demand 
(PD) and Temporal Demand (TD), Frustration (F), Effort (E) and Performance (P). The process to measure the workload using 
the TLX follows two steps: 1) familiarize the human operator with all the concepts of the NASA-TLX to be filled by the 
operator according the perception of the resource demand for specific task. Every subscale is pondered from 0 to 100 in 5-point 
steps. 2) The second step creates a weighting for every subscale through pairwise comparison. The TLX method has been used 
on areas of medicine, psychology and ergonomics to measure the workload using a HMI [22, 23, 24]. The NASA-Raw Task 
Load Index (NASA-RTLX) is a variation of the TLX method, created to reduce the time required to apply the evaluation. The 
NASA-RTLX eliminates the need of the pairwise comparison, simplifies the procedure and does not represent missing 
information on sensitivity [19]. The operator workload can be calculated using Equation 1: 


OW == %k Eq. 1 


Where: OW is the Operator Workload, 1 < n <6, and S, represents the k subscales of the NASA-TLX. 


Figure 3. NASA-TLX questionnaire, the tool used to measure the subjective opearator workload, image taken from [25]. 
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E. Software In The Loop (SITL) 


SITL is software that allows testing under simulation a Plane, a Copter or a Rover vehicle without any hardware. The 
simulator runs on a PC, to build the autopilot’ code used for real vehicle prototypes and allows for testing of the behavior of 
the code. The simulator can run natively on Linux platform and other Operating Systems like Windows and Mac. The 
simulator works with the MAVLink protocol. The results of the SITL are identical to those produced when is executed using 
a real vehicle. Information about the MAVLink commands, simulation, testing using SITL and other relevant topics can be 
found at http://ardupilot.org/dev [18]. 


IHI. METHODS 


A. Proposed solution 


A two-staged solution 1s proposed to achieve the final objective: to provide an adaptive HMI for reducing the operator 
workload and the accidents caused by human factors. The stages are: 1) the TLA implementation and 2) development of the 
adaptive HMI. Figure 3 shows the general schematic of the proposed solution. The architecture proposed is based on the TLA 
(described on the section II A) and widely used on mobile robots [26, 27]. The TLA is implemented on the microprocessor 
onboard of the UAV. The control commands and plannings, which are sent to the UAV by the operator using a wireless 
channel, are received in the highest layer of the TLA. The information received 1s evaluated to get the command type and 
evaluate its syntax. If the command type is a plan to be accomplished by the UAV, the planning layer provides the plan into 
sequencer. Once the sequencer layer receives a plan, it is processed to achieve the goals planned. The sequencing layer 
identifies skills declared on the plan and requests its activation to the lowest layer known as skills layer. 


The lower layer includes a set of skills also known as primitive behaviors. The set of skills 1s compiled as a skills library 
and every single skill is a reusable software component. Additional information as parameters of the skills and the outputs are 
defined into the skills library. The outputs of the skills are reported through the HMI to the operator on runtime during a flight 
plan. If the active skill has achieved its specified goal, the “finished” state 1s reported to the sequencing layer and it sends a 
signal to the operating system to terminate the skill. The sequencer requests the activation of the next skill until the plan has 
been finished. The dynamic activation allows managing and balancing the information at the HMI to show just the data on 
runtime of the activated skill. The TLA has been implemented within the microprocessor on board of the UAV. 


Figure 4. General scheme of the solution proposal. The three layer architectecture is implemented on a microprocessor onboard of the UAV. 
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B. Infrastructure 


The mobile devices have been used to improve the interaction between the users and the interfaces. This work proposes the 
use of mobile devices due to their portability and immediate response to the choices selected by the user. A tablet (multitouch 
device) has been chosen to implement the adaptive HMI. A teleoperation-based HMI (traditional HMI) is also used to control 
and communicate with the UAV. Both HMIs will be used to measure the operator workload during a flight plan. The UAV 
utilized is a quadcopter assembled at the Center of Information Technology (Cinvestav LTI). The Figure 5 shows the UAV 
used in the experimentation. The details of the infrastructure are listed on the Table I. 
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Figure 5. Quadrotor UAV assembled on the CINVESTAV LTI using a microprocessor Raspberry PI andd NAVIO+. 





TABLE I. DETAILS OF THE INFRASTRUCTURE 
Device Features 
Multitouch device Tablet Samsung sm-t560nu Quad core processor, 


16GB internal memory, 9.6 in WXGA display. 
Traditional HMI Radio control Futaba T6EX model, 2.4GHz. 


UAV Raspberry Pi 2 model B, with 900 MHz, Quad 
core ARM Cortex-A7. 1GB RAM, OS Raspbian, 
telemetry modules, a controller NAVIO+ and rest 
of devices for the assembly. 


C. First Stage: the three layer architecture 
1) Planning layer 

The planning layer is the highest level module. The planning layer receives the navigation commands and plans. It 
evaluates the syntax of command received using a set of regular expressions. The syntax rules were written using Flex and 
Bison, which are tools for building programs that handle structured input [16]. Flex is used to build lexical analyzers and 
Bison is often used to build parser generators. The TLA in the planning layer contains ROS nodes for exchanging commands 
and data flight between the operator and UAV, evaluating the type of the command received, establishing configurations and 
analyzing syntax of the plans. The set of regular expressions created to evaluate the syntax 1s small; however, 1t 1s easy to 
increase the capabilities of the TLA to extend the set of instructions to provide bigger flexibility. Some of the regular 
expressions used to evaluate the received commands are shown in the Listing 1: 


Listing 1. Regular Expresions. 


start: command type asigna inst 
command type: cmd | pln | cnf 
inst: 
PAR I PARAL inst PAR D inst | 
PAR _ I behavior PAR D inst | 
BEH UPD PAR I behavior PAR D 
| JOYCMD NAV PAR I joycmd nav PAR D 


The commands received on the TLA and evaluated with the syntax rules listed above are: 


cmd: execute commands that are not part of the skills library, e.g., enable the TLA for listen and execute a plan 
pln: execute one or more skills of the library organized to achieve a goal. 
cnf: execute configuration commands of the controller 





2) Sequencing layer 
The sequencing layer manages the plans to be executed. If the command type received in the planning layer is a plan and 
the syntax is approved, the plan is received by the sequencing layer and it is segmented into skills. A queue keeps the 
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activation order of the skills and the sequencer requests to the skills layer to confirm the existence of the skill. If the 
confirmation 1s received, the sequencer sends an activation signal to the rospawn node. Otherwise, the sequencing layer sends 
a message to the planning layer to abort the current plan. 


3) Skills layer 

The skills layer stores the skills that are activated by request of the sequencing layer. Each skill in the library allows the 
UAV to execute a specific task. A skill is a software component implemented in ROS as a node that can be activated 
dynamically, according with the plan provided by the operator and introduced using the HMI. The TLA includes the skills 
library in the lowest layer as a ROS node that reads an xml file to keep a registry of all the skills that the UAV is able to 
perform. The skills execute basic instructions such as takeoff, landing, or any other task that modifies the internal state of the 
UAV. The list below is part of the skills registered at the library: 


e arm: Allows the UAV to listen navigation commands. 
e takeoff: Request the UAV to reach certain altitude. 
e land: The vehicle lands in the current position. 


e guided: Change the operation mode of the UAV to guided mode that allows it dynamically guide the vehicle to a 
target location using telemetry radio module and GCS. 


The skills are executed using the package mavros to control the actuators and sensors and modify the internal state of the 
UAV. If a reused component is added at the skill library, the component is modified to include an abstract base class called 
“behavior”. The class adds a finite state machine (FSM) that allows controlling the different states of the skill and reports the 
task progress. The FSM is shown on Figure 6 which describes the stages of a skill to reach its goal. 


D. Second Stage: adaptive human-machine interface 


The second stage involves the development of an adaptive HMI. The adaptive approach utilizes the TLA to balance the 
information displayed to the operator. The information of the data flight displayed corresponds with the skills activated during 
the plan execution. If the information is adjusted to the task of the UAV, the operator workload is reduced. To validate the 
reduction of the operator workload the subjective instrument NASA-TLX will be used to measure it (RTLX). The values of the 
operator workload will be compared with the values using the teleoperation-based HMI. The preliminary results of the 
measurement the operator workload using the teleoperation-based HMI are included in this paper. 


A total of ten untrained volunteers (operators) participated at the evaluation of the operator workload using the 
teleoperation-based HMI. Participants were screened with two requirements: 1) at least high school level education and, 2) no 
motor or visual disabilities. Every operator was required to perform the activity called task 1. The task has three waypoints 
that must be reached by every operator. Once every waypoint is visited, the operator moves the UAV to the starting point 
known as HOME to finally land the UAV. The operators completed the task_/ in the first scenario using the traditional HMI. 
At a second scenario, the operator must complete the task _/ using the adaptive HMI. Each operator is requested to fill up the 
NASA-TLX questionnaire after finishing the task for both scenarios to evaluate the operator workload. 


Figure 6. Finite state machine included in the abstract class to reuse software components. 
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IV. RESULTS 


A. Implementation of the three layer architecture 


The TLA capabilities were tested using software in the loop (SITL) simulation and linking the mavros package with the 
Flight Control Unit (FCU). The Figure 7 shows the SITL and ROS running the mavros package and the TLA during the 
testing phase. 


Figure 7. Output of the SITL linked with ROS. The console and the virtual map show the behaviors of the UAV during the execution of a plan. The 
terminal show the topics used by the TLA, the mavros node, and the mavlink protocol that communicates the virtual UAV and ROS. The graphic a) shows 
the SILT running, b) shows the TLA waiting for plans or commands, c) Mavros packages, d) List of the topics actually available, e) and f) the map and the 

console to monitoring the UAV behavior during the simulation. 
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SITL allows running a simulation of a quadcopter UAV directly on a computer, emulating the result of the execution of 
navigation commands as in the real environment. Mavros allows the use of the MAVLink protocol to extend the 
communication between ROS and GCS. The Figure 8 shows the TLA and its nodes in execution and the communication 
buses (topics) between the nodes before processing the plans received from the HMI. The commandServer node sends the 
plans for the planning node to analyze the syntax and approve 1t. During the idle phase, the TLA does not have any 
communication with the skill layer. To evaluate the TLA functionality a plan is sent to the UAV, the behavior of the UAV is 
then validated using SITL. The plan used to test the UAV is shown Listing 2. 


Listing 2. A plan used to evaluate the UAV behavior, it request to the vehicle change its operation mode and changes it to guided mode, arm the vehicle 
and takeoff to 10 meters as target. 





“pln <- (guidemode)(arm)(takeoff args: altitude = 10)(land)” 


The instruction sent to the UAV requests a change from the operation mode to guided mode, execute the arm command 
and reach an altitude target of ten meters for the takeoff command. Once the target is reached, the UAV goes back to land. 
The Figure 9 shows the communication buses between the guidedMode skill while a plan is processed. The mavros node 
reports the operation mode through the /mavros/state topic. Each skill in the queue of the sequencer is validated upon request 
a Boolean response from the skill library if the skill exists. If the skill reaches its goal, the “finish” status is reported to the 
sequencer and its deactivation is requested. The rospawn node keeps the list of the active skills using the process id (pid) 
assigned by ROS. The deactivation of the skill is processed terminating the process using its pid. The dynamic activation of 
the skills is used to adjust the information balancing on the adaptive HMI. To reduce the operator workload, only the output 
generated by the active skill is reported. 
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Figure 8. The TLA before the activation of the registered skills in the library. In the idle phase the sequencing layer does not keeps communication with the 
skill layer to modify the internal state of the UAV. 
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Figure 9. The TLA during the execution of a plan and the activation of skills. In the phase of execution, the sequencing layer request the confirmation if 
there is a skill registered on the library node called as the skills to activate. If a skill is active, it is able to get feedback from the mavros package about the 
current internal state, i.e. guidedMode. 
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B. Operator workload (preliminary results) 


The operator workload was used as performance measurement. The Figure 10 shows the results of the total operator 
workload of the ten untrained operators that participated in the experiment. The measurements are represented just to the first 
scenario using the teleoperation-based HMI. The metrics were calculated using the method NASA-RTLX. The variable 
represented by the y axis is the total of the subscales evaluated (operator workload). The x axis represents the volunteers 
denoted by S, where n= {1, 2... 10}. The operators were given a time limit of 15 minutes (due to battery time) to complete the 
task, without constraints in the number of attempts. Two of ten operators perceived a total demand of the task with values 
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lower that 50 percent. For the rest of them, the operator workload perceived is over 60 percent of demand during the task 
execution. The demand perceived for novice operators confirms the importance of reducing the demand, in order to minimize 
the risk of suffering a human caused accident. Table II shows the values of every subscale in the NASA-TLX of the operators 
for the experimentation in this paper. 


Figure 10. Operator workload of the operators at the first scenario, the x axis represents the operator denoted by S,, and the y axis represents the operator 
workload denoted as cost. 
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TABLE II. VALUES OF THE NASA-TLX SUBSCALE FOR EACH OPERATOR AT THE FIRST SCENARIO. 


Subjective value subscales 


A 
Human operator eee ae ee) S| OW 
AAA 
AAA 
LIRA A E EEE. 
MPAA AA RILE 
AAA 
Só TS 50 56.6 
EAS 
MU MN A A EA 
EA 


V. DISCUSSION 


The use of the UAV on wide fields of application increases the interaction between the human and the UAV. If an 
operator has not enough expertise, the risk of an accident is bigger compared with expert users. A high percentage of UAV 
accidents are associated with human errors. The human causal factor includes the operator workload and the ergonomic 
design of the HMI. The preliminary evaluation of the workload presented in this work provides an idea of the high cognitive 
demand of novice operators to complete a small task and successfully control the UAV using a teleoperation-based HMI. 
This work presents an attempt to enhance the interface to balance the information with an adaptive approach and using 
multitouch mobile devices. The expectation is that balanced information presented on the display of the mobile device, 
allows the operator to be focused on the current context of the skill executed by the UAV, reducing the operator workload 
and the number of accidents. The dynamic reconfiguration feature of the TLA presented in this work is the base to achieve 
the reduction in the operator workload and balance the information in the adaptive HMI. 
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VI. CONCLUSION 


This work shows a general idea of a solution proposal; however, this paper is focused on the development and 
implementation of the three layer architecture and the results of its testing on simulated environments. This development 
contributes with one of the first attempts to implement this architecture on the field of the UAV, especially on a quadrotor 
with an onboard microprocessor, using ROS as main platform. The TLA and the inherent features by its implementation on 
ROS such as dynamic communication between nodes, allows to consider the development of adaptives human machine 
interfaces. This approach could be considered as an alternative to address the growing human-machine interaction in a trusty 
and safe manner. 
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Dispositivo robótico coadyuvante para la rehabilitación de dedos de la 
mano 


A. Zapatero Gutiérrez', J. F. Rodríguez León', J. F. Aguilar Pereyra”, E. Castillo Castañeda' 


Resumen- Se presenta el desarrollo y validación de un dispositivo robótico coadyuvante para la rehabilitación de dedos de la 
mano, el cual tiene por objetivo realizar movimientos asistidos de flexo-extensión de los dedos. El presente documento aborda 
desde el diseño del dispositivo, su correspondiente análisis cinemático y la validación del mismo a través de técnicas de 
procesamiento de imágenes. En base a los resultados, se obtiene un dispositivo reconfigurable donde las trayectorias 
correspondientes a los movimientos de flexión—extensión y extensión—flexión son semejantes y corresponden a los movimientos 
de las puntas de los dedos, corroborando de esta manera la funcionalidad del prototipo. 


Palabras Clave: Rehabilitación Robótica, Flexo-extensión de los dedos de la mano 


I. INTRODUCCIÓN 


Las extremidades superiores son vitales en las actividades cotidianas de los seres humanos, en ocasiones sufren lesiones 
causadas por accidentes y/o enfermedades que disminuyen o impiden su funcionalidad. Los dedos de la mano son parte 
primordial y estratégica de estas extremidades, para enfatizar su importancia cabe mencionar que tan sólo al dedo pulgar 
se atribuye el 40% de la funcionalidad de la mano [1]. 


Los dedos de la mano son los encargados de realizar funciones como sostener un objeto, realizar trabajos de precisión y 
fuerza, detectar texturas, e inclusive sirven como extensiones del cuerpo para registrar sensaciones ambientales como el 
frío o el calor. 


Actualmente uno de los métodos más usados para la rehabilitación de dedos son las llamadas férulas u órtesis dinámicas, 
que son dispositivos sanitarios que actúan sobre las articulaciones interfalángicas, aplicando presiones mediante 
diferentes apoyos y/o controlando los procesos de flexo-extensión de los dedos [2]. 


El problema de estos dispositivos es que suelen ser semielaborados y en algunos casos se confeccionan “a la medida” [2], 
lo que resulta en un método no sistemático. Eso sin contar que se requieren distintos tipos de férulas según el proceso de 
rehabilitación. 


El impacto principal del dispositivo presentado en las siguientes páginas radica en el aspecto tecnológico y económico, 
ya que, al ser un dispositivo pensado para beneficio del sector de salud pública, permitirá optimizar los recursos al 
servicio de la sociedad. 


Las terapias clásicas de rehabilitación son aplicadas por terapeutas especializados quienes se apoyan en sistemas de 
terapias manuales. Se ha comprobado que el uso de sistemas robóticos en las terapias de rehabilitación incrementa los 
beneficios respecto a las terapias manuales al incorporar tareas de ejercicio intensivas e interactivas [3,4]. Es importante 
mencionar que los sistemas robóticos utilizados para asistencia en rehabilitación no tienen la finalidad de reemplazar al 
terapeuta, sino que constituyen una valiosa herramienta que potencializa su labor. 


Aunque existan sistemas automáticos para asistencia en rehabilitación fisica desarrollados en otros países, cuando estos 
llegan a México los costos de los equipos los hacen inaccesibles para la mayoría de las instituciones médicas del sector 
público. En esta línea, el único dispositivo para rehabilitación de dedos, actualmente disponible de manera comercial, es 
el desarrollado por la empresa austriaca Tyromotion [5], denominado como Amadeo®, que permite la rehabilitación de 
los cinco dedos; sin embargo, su precio se encuentra aproximadamente en 43,000 euros [5], lo que lo hace aun de difícil 
acceso para instituciones médicas públicas. 


Los equipos especializados para la rehabilitación física de personas resultan ser una rama de desarrollo poco explorada, y 
que necesita ser cubierta para responder a la necesidad de la población afectada, y que no cuenta con los recursos 
económicos para adquirir un equipo comercial de rehabilitación. 


1 $ ae P ` A 7 A ae : : 7 PAE 
Centro de Investigación en Ciencia Aplicada y Tecnología Avanzada, Instituto Politécnico Nacional, Querétaro, Qro. México. 

2 a oooh E A = acy À s ae z E ne 
División de Tecnologías de Automatización e Información, Universidad Tecnológica de Querétaro, Querétaro, Qro. México. 


211 


Robótica y Mecatrónica de Servicios: Teoría y Aplicaciones. Capítulo 22, páginas 211 - 220. 
ISBN 978-607-9394-06-6, Asociación Mexicana de Mecatrónica, A. C. 


En México, en cifras oficiales del 2010, el Instituto Nacional de Estadística y Geografía (INEGI), reportó que el 5.1% de 
la población resultó con alguna discapacidad, y que el 58.3% de ellos tiene alguna limitación para caminar o moverse [6]. 
En este trabajo, presentamos el desarrollo y validación de un dispositivo robótico coadyuvante para la rehabilitación de 
dedos de la mano, el cual tiene por objetivo realizar movimientos asistidos de flexo-extensión de los dedos. 


I. DISENO DE DISPOSITIVO ROBOTICO 


Se desarrolló un dispositivo robótico de asistencia para rehabilitación de dedos de la mano, que es reconfigurable y puede 
ser utilizado en movilización pasiva y activa de flexión y extensión de los dedos de la mano, como ejercicio de las 
articulaciones en mecanoterapias de rehabilitación física. 


El sistema está compuesto de una base fija de altura variable que sujeta el antebrazo, cuatro mecanismos RRRT tipo 
manivela—biela—corredera, reconfigurables al tamaño de los dedos de la mano, impulsados por actuadores rotacionales 
ubicados en los cuatro planos de flexo-extensión de los dedos índice, medio, anular y meñique, ver Figura 2.1. 


Brazo 










Soporte del 

brazo 
Perilla de 
ajuste de 
altura 





4 Mecanismos RRRT 


Figura 2.1. Dispositivo robótico para rehabilitación de dedos de la mano. 


Los mecanismos RRRT reconfigurables movilizan las articulaciones metacarpofalángica e interfalángicas proximal y 
distal de los dedos índice a meñique, guiando el extremo distal de cada dedo por la trayectoria natural de flexoextensión, 
lo que evita el movimiento del dedo fuera de su espacio de trabajo, reduciendo el riesgo de lesión por hiperextensión. Los 
ejercicios de movilización del extremo distal del dedo pueden ser pasivos, es decir, que se proporciona la fuerza de 
movilización por el mecanismo, o activos, donde el usuario aporta la fuerza que produce el movimiento. 


En virtud de alcanzar la eficiencia del dispositivo se desean movimientos suaves y continuos desde el inicio (Lim pex) 
hasta el fin del recorrido (Lim,,;). Por lo anterior, la amplitud y velocidad de los movimientos deben controlarse para 
cada instante de tiempo. Se puede comenzar con oscilaciones de baja amplitud y velocidad e incrementar ambas hasta 
alcanzar el intervalo completo de flexo-extensión, siempre bajo estricta supervisión de fisioterapeutas profesionales para 
evitar movimientos bruscos que causen excesivo dolor o daño adicional. 


La longitud de cada dedo define las dimensiones del mecanismo correspondiente. La síntesis de los mecanismos flexo- 


extensores se realizó a partir de un método de generación de trayectoria con tres puntos de precisión con base en las 
curvas del eslabón acoplador [7], ubicado en la Figura 2.2 por el punto C. 
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Lim pex \ > Y Limo 











Figura 2.2. Mecanismo RRRT representativo del dispositivo robótico. 


II. ANÁLISIS CINEMÁTICO DEL DISPOSITIVO 


El análisis cinemático del mecanismo se realizó a través del análisis vectorial, con el cual se determina la posición, 
velocidad y aceleración del punto de unión entre el extremo móvil del dedo y el extremo del eslabón acoplador, punto C. 
En la Figura 3.1 se muestra el diagrama vectorial que representa al mecanismo RRRT; el vector r, tiene su punto inicial 
en el origen O del marco de referencia local xy, y su punto final en la unión con el eslabón acoplador, el punto A. El 
vector rg también tiene su punto inicial en el origen O y su punto final en B, el cual se desplaza horizontalmente sobre el 
eje x. El vector ryc tiene su origen en el punto A y su punto final en el extremo del eslabón acoplador que se une al 
extremo del dedo a movilizar, el punto C y el vector rc también tiene su punto inicial en el origen O y su punto final en 
C. Finalmente, el vector r4z tiene su punto inicial en A y su punto final en B [8]. 





Figura 3.1. Diagrama vectorial del mecanismo RRRT. 


Por lo anterior, se establece que: 
Tp — Ya + TAB (3.1) 
Tc — ra + Tac (3.2) 


El punto A gira respecto del origen O en función del ángulo y, por lo que La posición, velocidad y aceleración del punto 
A está definida por el vector r, y su primera y segunda derivadas respecto del tiempo [8]: 


Ta =x, +y, = L¿cosp21+ L,sen q] (3.3) 
Va = Ta = Xal+Yaj = —Lop¿senp2i+ L22 cos P2 Î (3.4) 


= (—L2 2 sen pz — L, (5 cos p2)i + (L2Q, COS P2 — L2Q5 sen pz) 


donde L, es la magnitud del vector r4, pk es la velocidad angular œw y Gk es la aceleración angular a; [8]. 
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El punto B únicamente se desplaza sobre el eje x, por lo que su componente en el eje y es constante y de magnitud nula. 
La posición, velocidad y aceleración del punto B está definida por el vector rg y su primera y segunda derivadas respecto 
del tiempo [8]: 
(xp — x4) + O — Ya)? = La” (3.6) 
ra = tat Tap = xatt yo) = (a+ 2 ya)t+ Oj (3.7) 


Vg = Tg = Xpttyef = (—L-¢Ø- sen p- + L, k; seng,)i+ Of (3.8) 


Ag = Ta = XglT YB] = 


zz sen pz — L$ cos pa, + kz La sen pz — kf i = y) O (3.9) 


con: 
—L>0Q» COS 
= 2P2 P2 
Ji E V4 
y 


-LÖ COS Pp + Lz? sen p, — Lk? sen p, 


jis) — YA 


donde L, es la magnitud del vector r4g que es constante [8]. 


k, = 


El punto C es el extremo del eslabón acoplador que define la trayectoria deseada del extremo movil del dedo. El ángulo 
Ø, se forma entre el vector r,p y la línea que pasa por el punto A, paralela al eje x y está definido por (3.10) [8]: 


(=) — 22) =L, (3.10) 
3 = arco seno | ——} = arco seno | —————| = —— 9) 
3 L3 L3 
El ángulo del vector r¿c respecto del eje horizontal es [8]: 
P31 = P3 + Ó31 (3.11) 


La posición, velocidad y aceleración del punto C está definida por el vector rc y su primera y segunda derivadas respecto 
del tiempo [8]: 


ro =T; +Tac = (xa + xac) t Wa +Yac)) (3:12) 
= (L COS Pz + L31 cos p31)1 + (Lz sen pz + L31 sen 31) 
Veo= Te Tatae = Xcit+ycej = (3.13) 
= —(L2@2 sin p + L31031 Sin P31)t + (L22 COS P2 + L3131 COS P31) 
Ac = ce =Y4a +t rac = ¥cî+ýc) = (3.14) 
= (-—L2@2 SİN p, — L2Q5 COS P2 — L3,P31 SEN P31 — 131931 COS P31) 
+ (L292 COS Pz — Las sen pz + L31G31 COS P31 
— 131931 SIN P31)J 


donde L3, es la magnitud del vector r4c [8]. 


Las Figuras 3.2 a 3.4 muestran las trayectorias de los puntos A, B y C del mecanismo propuesto cuando la variable de 
entrada es el desplazamiento en B. 
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Figura 3.3. Curvas de Posición, Velocidad y Aceleración del Punto B. 
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Figura 3.4. Curvas de Posición, Velocidad y Aceleración del Punto C, para 180° < ø < 360°. 


IV. VALIDACIÓN EXPERIMENTAL 


Para la validación del dispositivo se realizó el análisis de trayectoria que este genera en su efector final, punto C, donde 
se posiciona el dedo del paciente. En la Figura 4.1 se muestra el dibujo del mecanismo propuesto para un solo dedo. 


Como primer paso en la validación experimental se realizó el control del mecanismo para generar las trayectorias de 


flexión y extensión. 





Figura 4.1. Mecanismo de cuatro barras reconfigurable para un dedo. 


Debido a que los actuadores que producen el movimiento de los mecanismos flexoextensores son servomotores de 
corriente directa, se seleccionó el sistema de control PicServo®, ver Figura 4.2. Este sistema comercial consiste en una 
tarjeta de comunicación SSA-485 Smart Serial Adapter y cuatro tarjetas controladoras de movimiento PIC-SERVO SC 


Motion Control Board. 
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Figura 4.2. Interfaz PicServo®. 


Se instalaron interruptores de fin de carrera en los extremos de la trayectoria de la corredera para limitar su 
desplazamiento. 


Posterior a generar los movimientos controlados de flexión y extensión en el mecanismo, se procedió a realizar tomas de 
videos correspondientes a las trayectorias, y mediante software, la descomposición de éstos en imágenes; para luego 
analizar cada una de ellas y detectar el efector final, ver Figura 4.3. 





Figura 4.3. Trayectoria del punto C. 
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Con el punto C identificado, correspondiente al efector final, en cada una de las imágenes, se realizó la clasificación de 
este punto respecto de los demás datos de la imagen; se le asignó el color negro al punto C y el color blanco a los demás 
datos de la imagen, tal como se aprecia en la Figura 4.4. 


Figura 4.4. Clasificación del punto C (color negro) respecto de los demás datos de la imagen. 


Una vez realizada dicha asignación, se analizó el centro de masa del punto del punto C mediante coordenadas xy, tal cual 
se muestra en la Figura 4.5. 


Coordenadas X 
Coordenadas Y 


Coordenadas * 


e Coordenadas X 





Figura 4.5. Centro de masa del punto del punto C. 


Con las coordenadas xy de cada imagen se procedió a graficar los puntos para visualizar la trayectoria que el mecanismo 
genera de los movimientos de flexión y extensión. 


En la Figura 4.6 se ilustran las trayectorias del mecanismo, de color negro se observa la trayectoria de los movimientos 
de flexión a extensión, y en color rojo la trayectoria de extensión a flexión. Nótese que las trayectorias que genera el 
mecanismo son coincidentes a lo largo de los movimientos de flexión y extensión, sin embargo, en su punto inicial de 
flexión, el mecanismo presenta juego mecánico debido a la estructura de la articulación. 


Finalmente se analizaron las posiciones en las coordenadas xy del mecanismo respecto al tiempo de ejecución de los 
movimientos de flexión y extensión. En la Figura 4.7(a) se observa la posición de la coordenada x de color negro, y de 
color rojo la posición de la coordenada y; estas coordenadas se analizaron respecto al tiempo de ejecución del 
movimiento de flexión-extensión. 
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Figura 4.6. Trayectorias del mecanismo: movimientos de flexion a extension (color negro) y movimientos de extension a flexion (color rojo). 
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Figura 4.7. Coordenadas xy respecto al tiempo de ejecución del movimiento de: (a) flexión-extensión, (b) extensión- flexión. 


En la Figura 4.7(b) se aprecia la posición de la coordenada x de color negro, y de color rojo la posición de la coordenada 
y, estas coordenadas se analizaron respecto al tiempo de ejecución del movimiento de extensión-flexión. 


Nótese que la posición inicial del movimiento de flexión—extensión en las coordenadas xy, es la posición final del 
movimiento extensión—flexión, y que la posición final del movimiento flexión—extensión en coordenadas xy, es la 
posición inicial del movimiento de extensión—flexión. 


En conclusión, el mecanismo genera dos trayectorias similares, una para flexión—extensión y otra para extensión—flexión. 
Las cuales representan la posición del efector final. 


V. TRABAJO FUTURO 


Como parte del trabajo próximo a desarrollarse se planea diseñar y habilitar el mecanismo para la rehabilitación del dedo 
pulgar, que por sus características anatómicas difiere de los movimientos de los demás dedos de la mano. Esto con la 
finalidad de obtener un prototipo para los cinco dedos, el cual deberá ser evaluado para determinar la eficiencia del 
mismo y la forma de control más apropiada. 


También es deseable obtener los valores correspondientes a las fuerzas resultantes del análisis dinámico del mecanismo, 
así como sus pertinentes pruebas con pacientes, bajo supervisión médica y con la aprobación de los comités de ética 
pertinentes. 
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VI. CONCLUSIONES 


Bajo el esquema de contribuir en el aumento en la calidad de las terapias de rehabilitación de dedos de la mano, se 
desarrolló un dispositivo robótico reconfigurable que desarrolla los movimientos naturales de flexo-extensión de los 
dedos de la mano, exceptuando el pulgar. El dispositivo se puede ajustar a distintos tamaños de dedos de la mano, 
ampliando el rango de atención para pacientes que requieran rehabilitación de dedos. 


Se realizó el correspondiente análisis cinemático del mecanismo propuesto, así como la validación de las trayectorias 
correspondientes, obteniendo resultados que corroboran la correcta ejecución de la tarea a desempeñar. A través de la 
validación del mecanismo se comprueba que las trayectorias correspondientes a los movimientos de flexión—extensión y 
extensión—flexión son semejantes. 


Trabajamos para que, a mediano plazo, el prototipo cuente con la inclusión de los movimientos para la rehabilitación del 
dedo pulgar y la mejora respectiva en el control del dispositivo. Dejándolo habilitado para las pruebas pertinentes con 
pacientes. 

Es importante enfatizar que el sistema debe ser usado bajo estricta supervisión de un fisioterapeuta o personal médico 
capacitado. 
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